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1.0.  INTRODUCTION 

This  report  summarizes  the  work  done  by  Oakland  University  on  Army 
contract  DAAE07-84-Q-R083.  Oakland  University  explored  a  new  method  of 
state  feedback  control  designed  to  regulate  the  output  of  continuous 
systems.  The  new  approach,  based  on  a  table  lookup  technique,  results  in 
a  controller  which  is  faster,  less  complicated,  less  expensive,  and  more 
reliable  than  present  military  controllers.  Since  the  new  method  models 
both  the  discretion  of  time  and  the  quantization  of  state,  it  is  referred 
to  as  Discrete  Time  Quantized  Data  (DTQD)  system  theory.  This  theory  is 
still  being  developed.  The  main  objective  of  the  first  stage  of  the 
research  effort  is  to  develop  the  theory  so  controllers  can  be  designed  to 
regulate  systems.  This  has  been  done. 

The  discussion  portion  of  the  report  is  divided  into  four  major  sections. 
The  first  section  develops  the  theoretical  foundation  needed  to  design 
controllers  based  on  the  new  technique.  Next,  the  software  package  which 
has  been  developed  to  aid  in  the  design  of  these  controllers  is  outlined. 
The  last  two  sections  apply  the  theory  to  a  typical  military  application. 
The  first  of  these  two  sections  derives  a  mathematical  model  of  the  gun 
elevation  system  of  the  M60  tank.  The  next  section  uses  the  model  to 
develop  and  simulate  a  controller  for  the  elevation  system.  The  response 
of  the  controller  is  examined.  As  might  be  expected,  the  controller 
responded  quite  favorably  as  a  regulator.  However,  when  sinusoidal 

disturbances  are  applied  to  the  tank  hull,  the  controller  did  not  damp  the 

disturbances  as  well  as  current  technology.  It  was  not  designed  to. 
Research  is  continuing  in  the  area  to  improve  the  disturbance  canceling 
characteristics  of  the  controller  and  provide  tracking  abilities.  The 
software  package  used  to  design  the  controllers  is  completely  documented 
in  an  appendix.  Finally,  the  complete  source  listing  of  the  software 

package  is  provided  in  another  appendix. 

2.0.  08JECTIVES 

The  objectives  for  this  research  are  as  follows: 

1)  Develop  and  refine  a  new  application  of  control  theory  based  on 

look-up  table  techniques  and  the  effects  of  state  quantization  in 
digitally  implemented  control. 

2)  Develop  DTQD  analogs  of  controllability  and  observability  of 
systems . 

3)  Determine  the  improvements  in  system  response,  ease  of 

implementation,  and  system  reliability  given  this  methodology. 

3.0.  CONCLUSIONS 

This  research  is  very  promising.  The  theory  needed  to  design  a  DTQD 
controller  has  been  completed.  A  computer  program  to  aid  in  the  design  of 
these  controllers  has  been  developed.  The  theory  has  been  applied  to  a 
military  application  and  the  system  simulated.  The  results  showed  that 
the  theory  worked  quite  well  in  regulating  the  system,  but  when 
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disturbances  were  added  the  response  became  noisy.  This  was  not  entirely 
surprising  since  the  theory  behind  the  design  of  the  controller  was  not 
developed  to  reject  disturbances.  However,  a  slight  modification  of  the 
scaling  algorithm  should  reduce  the  magnitude  of  the  noise.  This  idea  is 
suggested  within  the  report  and  should  be  further  developed. 

The  analogs  to  controllability  and  observability  for  DTQD  systems  are  not 
addressed  in  this  report-  This  area  is  currently  being  explored  and 
results  will  be  forthcoming. 

The  regulation  of  systems  without  system  or  measurement  noise  using  DTQD 
controllers  seems  to  be  comparable  to  traditional  control  methods.  A 
complete  discussion  on  the  implementation  of  the  technology  into  digital 
hardware  is  in  the  body  of  this  report.  Since  this  circuitry  is  extremely 
simple,  the  resulting  DTQD  controller  will  be  more  reliable,  less 
complicated,  faster,  and  cheaper  than  the  controllers  using  traditional 
technology. 

4.0.  RECOMMENDATIONS 

Because  of  the  success  of  initial  research  into  DTQD  controllers,  a  follow 
on  project  should  be  conducted.  The  research  should  focus  on  noise 
rejection,  tracking  abilities,  output  driven  controllers  (instead  of  the 
current  state  feedback  structure),  and  application  of  the  theory  to  large 
scale  systems-  After  the  research  is  completed,  a  particular  application 
should  be  designated  by  the  military  to  implement  a  DTQD  controller,  and 
an  actual  controller  should  be  built  and  tested. 

5.0.  DISCUSSION 

5.1 .  DTQD  Theory 


5.1.1.  Introduction. 

Traditionally  there  have  been  two  approaches  to  the  digital  control  of 
systems.  The  first  method  finds  the  discrete  time  model  of  the  plant  and 
then  determines  a  controller  which  will  regulate  the  output.  Both 
classical  (using  Z  transforms)  and  optimal  control  techniques  have  been 
well  developed  for  this  approach.  In  the  second  method,  usually  reserved 
for  converting  existing  continuous  controllers  to  digital  controllers,  the 
designer  tries  to  emulate  a  continuous  controller  by  digital  circuits.  It 
is  not  clear  that  either  of  these  methods  is  the  best  strategy  for  using 
digital  electronics  to  control  a  plant. 

An  alternative  approach  [1-3]  to  controlling  digital  systems  is  presented 
here.  The  prime  consideration  in  deriving  the  new  control  structure  is  to 
develop  a  circuit  which  naturally  incorporates  the  unique  features  of 
digital  electronics.  The  new  approach  creates  a  "digital  model"  for  the 
system.  This  new  model  describes  the  relation  between  the  digital  inputs 
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and  outputs  of  the  system.  That  is,  the  effects  of  the  data  converters 
are  an  integral  part  of  the  modeling  process,  see  Fig.  5-1.  Once  this  is 
done,  the  controller  for  the  system  could  be  naturally  implemented  by  a 
digital  circuit.  The  controller  is  essentially  a  table  look-up  technique 
easily  constructed  from  digital  circuit  elements. 


Figure  5-1.  System  Model 

Other  authors  [4-6]  have  explored  developing  a  digital  model  for  continous 
systems.  They  have  given  up  for  two  main  reasons.  First,  there  is  the 
famous  problem  of  the  “curse  of  dimensionality."  That  is,  the  size  of  the 
control  table  will  increase  exponentially  with  the  number  of  states.  To 
accurately  control  even  a  second  order  system  by  this  method  requires  huge 
tables.  However,  this  problem  can  be  minimized  by  using  the  grid 
embedding  technique  proposed  in  this  report.  The  second  problem  with 
digital  models  is  that  in  general  its  output  will  diverge  from  the  actual 
system  output.  However,  with  proper  selection  of  the  quantization  levels 
and  sampling  interval,  the  rate  of  divergence  can  be  controlled.  Since 
the  primary  purpose  of  the  current  research  is  to  develop  a  feedback 
controller  for  the  digital  system,  then  a  model  which  adequately  describes 
the  system  for  only  one  sample  increment  will  be  sufficient  to  develop  a 
good  responsive  controller. 

This  portion  of  the  report  is  divided  into  several  sections.  Section 
5.1.2  develops  the  digital  model  for  a  continuous  linear  plant.  It  also 
shows  that  a  digraph  can  be  used  to  represent  the  digital  model.  Once 
this  is  done,  the  classic  graph  theory  algorithms  can  be  used  to  determine 
the  control  law.  This  is  examined  in  Section  5.1.3.  Section  5.1.4 
discusses  the  dimensionality  problem  and  suggests  a  solution.  Section 
5.1.5  illustrates  the  electronics  needed  to  implement  the  controller. 
Finally,  the  last  section  suggests  how  this  method  might  be  extended  to 
nonlinear  systems.  An  example  is  also  presented. 

5.1.2.  Quantization  Theory. 

Consider  the  system  illustrated  in  Fig.  5-1.  We  wish  to  find  the  relation 
between  the  digital  signals  U(k)  and  X(k).  First,  assume  that  the  plant 
is  a  linear  system,  that  is 

x(t)  =  Ax(t)  4-  Bu(t)  (5-1) 
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where 


X 


R 


n 


u  c  R*’ 

Modeling  the  effect  of  time  discretation  is  quite  easy.  Using  standard 
linear  system  theory  the  relation  between  x(k)  and  u(k)  is  represented  by 

x(k+l)  =  txCk)  4-  Ou(k)  (5-2) 

where 


T 

D  =  J  e  B  ds 

0 

T  =  the  sampling  period 

Now  the  data  converters  must  be  included  into  the  model.  To  do  this  a 
convention  must  be  established  to  represent  digital  signals.  Suppose 

there  are  j  bits  in  a  digital  signal,  then  there  are  2^  unique  pieces  of 
information  that  can  be  represented  by  the  digital  signal.  We  shall  use 

the  set  of  integers  [(-2^”^),...-l,0,l,...(2^~^-l)]  to  denote  each  piece 
of  information. 


Now  examine  the  0/A  converter.  Its  job  is  to  convert  p  digital  signals  to 
p  discrete  signals.  This  can  be  easily  done  by  multiplying  each  element 
of  the  U(K)  vector  by  an  appropriate  scaling  factor. 


u(k) 


U(k) 


(5-3) 


Recall  that  the  digital  input  is  modeled  by  a  set  of  integers,  that  is 
U(k)  is  a  vector  of  integers.  Therefore,  all  the  D/A  converter  is  doing 
is  mapping  the  integers  U(k)  to  a  vector  of  real  numbers  u(k)  according  to 
the  scaling  law  represented  in  (5-3).  Combining  (5-2)  and  (5-3)  we  obtain 
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x(k4-l)  =  $x(k)  1-  DrU(k) 


(5-4) 


The  A/D  converter  does  the  reverse  job  -  it  must  convert  the  real  numbers 
in  the  state  vector  to  integers.  For  most  converters,  this  process  can  be 
represented  by 

X(k)  =  floor  (x(k)/«)  (5-5) 

or  if  X  is  a  vector 
X^(k)  =  floor  (x.(k)/«p 

i  =  1 ,2, . . .n  (5-6) 

Many  converters  may  also  include  an  offset  p,  i.e.  X  =  floor  ((xfp)/6. 
For  the  purposes  of  this  paper  p  is  assumed  to  be  0.  This  is  done  for 
clarity  only.  It  does  not  alter  any  of  the  results.  Let  A  designate 
this  quantizing  operation,  that  is  X{k)  =  Ax(k),  then 

X(k+1)  =  Ax(k+1)  =  A[«x(k)  oru(k)]  (5-7) 

Unfortunately,  A  is  not  a  linear  operator,  therefore  the  right  side  of 
(1-7)  cannot  be  reduced.  In  fact  the  following  argument  will  show  that 
X(k+1),  in  general,  cannot  be  represented  as  a  function  of  X(k)  and  U(k). 

Consider  a  system  with  only  two  states,  then  the  data  quantization  process 
can  be  thought  of  as  overlaying  a  lattice  on  top  of  the  state  space. 

Every  state  x(k)  which  resides  in  a  single  cell  of  the  resulting  grid 
belongs  to  the  same  quantized  (or  digital)  state.  The  quantized  state 

X(k)  is  then  the  n-dimensional  integer  vector  representing  the  address  of 
the  cell.  For  example,  examine  the  situation  in  Fig.  5-2.  Here  all  of 
the  states  in  the  shaded  portion  of  the  state  space  are  assigned  the  same 

quantized  state  X(k)  =  (2,3)^.  The  problem  comes  after  the  system  makes 
its  transition  to  x(k+l).  Suppose  we  trace  each  state  in  the  shaded  cell 
for  one  transition  under  a  given  input  U(k).  If  x(k)  was  in  the  shaded 
cell  at  time  k,  then  at  time  k+1  it  must  be  in  the  parallelogram  abed. 
Unfortunately,  this  parallelogram  overlaps  four  distinct  cells.  So,  the 
X(k-Hl)  cannot  be  deduced  from  knowing  only  U(k)  and  X(k).  In  other 

words,  we  do  not  have  a  state-determined  system.  However,  knowledge  of 
X(k)  does  reveal  quite  a  bit  about  what  X(k+1)  can  be.  For  example,  in 

Fig.  5-2,  if  X(k)  =  (1,3)^  then  X(k+1)  must  be  either  (3,1)^,  (3,2)^, 

(4,1)^  or  (4,2)^.  Now  if  the  quantization  is  small  enough,  then 

transition  can  be  modeled  fairly  accurately  by  picking  any  one  of  the  four 
cells  as  the  actual  transition.  It  can  be  shown  [3]  that  the  number  of 
cells  that  are  overlapped,  after  a  cell  makes  a  transition,  can  be  limited 
with  proper  selection  of  the  sampling  interval  T  and  the  quantization  step 
size  Thus,  we  can  develop  a  digital  model  of  the  system  which. 
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although  not  exact,  will  never  be  more  than  one  cell  in  error  in 
predicting  the  state  for  the  next  transition. 


-4  -3  -2  -1  0  1  2  3  4 


Figure  5-2.  Quanization  of  a  Two  Dimensional  Space 

To  formalize  the  mathematical  definition  of  the  model,  we  will  trace  only 
a  single  point  in  the  cell,  namely  the  center.  So,  for  modeling  purposes 
only,  we  will  let 

X(k+1)  =  A(*y  OrU(k))  (5_8) 

where 

y  =  the  center  of  the  cell  X(k). 

Using  this  we  can  develop  a  state  determined  digital  model  or  for  the 
system. 

X(k+1)  =  ♦[X(k),  U(k)]  (5^9) 

As  was  mentioned  before,  this  model  is  not  exact  but  with  appropriate 
selection  of  T  and  4^'s  will  predict  X(ki-l)  to  within  one  cell.  This 
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reseach  is  primarily  concerned  with  developing  a  state  feedback  controller 
for  the  system.  Since  the  controller  can  sense  the  state  at  every  time 
interval,  developing  the  control  law  based  on  this  approximate  model 
should  yield  satisfactory  results.  In  fact,  this  model  provided  good 
results  in  the  systems  we  have  applied  it  to. 

5.1.3.  Control  Law. 

Consider  a  graph  S  whose  vertices  (nodes)  are  used  to  represent  each  cell 
in  the  discretation  lattice.  The  edges  in  S  then  form  the  set  of  all 
possible  transitions  between  the  cells.  For  example,  look  at  the  digraph 
in  Fig.  5-3.  This  graph  represents  a  simple  system.  If  the  state  is 

(0,1)^  at  time  k  and  an  input  of  0  is  applied,  then  the  state  will  be 

(0,0)^  at  time  k+1 . 


Figure  5-3.  Digraph  Representation 

We  now  examine  the  possibility  of  controlling  the  system.  Using  the 
example  presented  in  Fig.  5-3,  we  see  that  a  good  control  law  might  be 
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A;  if  X(k)  =  (1,1), (-1.1), (1,-1). 

U(k)  (-1,-1)  (5-10) 

C.0;  otherwise 

Using  this  law,  the  system  reaches  and  remains  in  state  (0,0)  in  minimum 
time. 

To  formalize  an  algorithm  to  determine  the  control  law,  consider  the 
following  cost  functional 

N 

J  =  I  C^j(U(k))  4-  Cj^(X(k))  (5-11) 

k=0 

where  C^j  and  are  two  non-negative  functions  of  U  and  X  respectively. 

The  optimal  control  law  of  the  sytem  U(k)  =  F  (X(k))  is  then  defined  as 
the  control  U(k)  which  must  be  applied  at  each  time  k  =  0,1,... N  so  that  J 
is  minimized.  This  formulation  resembles  traditional  optimal  control. 
This  was  done  intentionally  because  we  can  use  the  same  interpretations  of 
Cjj  and  Cjj  to  come  up  with  suitable  control  algorithms.  For  example,  if 

Cu(U(k))  =  1 

(5-12) 

Cx(X(k))  =  0 

then  we  have  a  minimum  time  system.  If 
C^J(U(k))  =  abs(U(k)) 

(5-13) 

Cx(X(k))  =  0 

then  we  will  have  a  minimum  energy  system.  Finally,  even  a  linear 
quadratic  regulator  problem  can  be  formulated  by 

Cu(U(k))  =  U^(k)  R  U(k) 

(5-14) 

Cj((X(k))  =  X^(k)  Q  X(k) 

where  R  is  a  positive  definite  matrix  and  Q  is  a  positive  semidefinite 
matrix. 

The  choice  for  representing  the  digital  model  now  becomes  apparent.  The 
optimal  control  law  formulation  presented  by  (5-11)  is  exactly  the  same 
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problem  graph  theorists  refer  to  as  the  "optimal  spanning  tree"  problem, 
where  C^j  is  used  to  weight  each  of  the  edges  and  weights  all  of  the 

vertices  in  the  graph.  Already,  there  are  well-defined  algorithms  to 
solve  this  problem  [7-8].  We  can  use  these  algorithms  directly  to  find 
F(X(k)). 

The  calculation  of  F(X(k))  can  all  be  done  off  line.  Once  F(X(k))  is 
known,  it  can  be  stored  in  a  PROM.  The  optimal  control  can  then  be  found 
by  addressing  the  PROM  with  the  measured  state  X(k).  This  leads  to  an 
extremely  simple  implementation  of  the  control  law. 

5.1.4.  Dimensionality. 

This  approach  suffers  from  the  "curse  of  dimensionality."  For  example, 
suppose  we  have  a  system  with  three  states,  where  each  state  is  quantized 

into  1024  =  2^®  levels.  Then  the  capacity  of  the  PROM  needed  to  store  the 

10  3 

control  algorithm  is  (2  )  or  roughly  one  billion  words.  This  is  clearly 

too  much  memory  to  expend  for  the  control  of  a  relatively  simple  system. 

This  difficulty  can  be  overcome  by  a  grid  embedding  technique.  Initially 
the  state  space  is  divided  into  a  rather  course  grid.  When  the  state  is 
far  from  the  origin,  these  large  divisions  are  adequate.  As  the  state  is 
driven  toward  the  origin,  however,  greater  accuracy  is  required.  This  is 
achieved  by  mapping  a  small  central  region  near  the  origin  of  the  state 
space  into  the  structure  of  the  original  discrete  configuration.  The 
process  is  continued  until  the  desired  accuracy  is  obtained. 

This  situation  is  depicted  in  Fig.  5-4.  As  the  state  moves  into  the 
center  sixteen  cells,  the  quantization  level  is  cut  in  half,  which  results 
in  the  center  16  cells  being  mapped  into  the  64  cell  structure  of  the 
original  system.  Since  the  embedding  process  will  not  occur  until  the 
state  is  within  the  specified  central  region,  then  the  state  must  be 
somewhere  in  the  64  smaller  cells  created  after  the  embedding  process. 
So,  at  any  time  the  controller  needs  to  examine  only  64  cells  to  derived 
its  control  strategy;  however,  after  each  embedding  the  size  of  the  cells 
are  cut  by  one-fourth.  Thus  the  controller  can  achieve  high  precision 
with  a  relatively  small  table. 

The  embedding  process  will  provide  sufficient  precision,  even  with 
relatively  few  cells  in  the  state  space.  However,  when  the  system  is  to 
be  represented  by  just  a  few  cells,  the  non-linearities  of  the  quatization 
become  significant.  A  way  of  modeling  the  non-linearities  must  be 
developed.  The  digital  model  proposed  in  this  paper  describes  these 
non-linearities. 

5.1.5  Implementation. 

Suppose  we  wish  to  implement  a  controller  for  a  second  order  system  in 
which  each  state  is  divided  into  16  divisions,  i.e.,  there  are  a  total  of 
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Figure  5-4.  The  Grid  Embedding  Technique 
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256  cells  representing  the  entire  state  space.  Embedding  will  take  place 
whenever  the  state  is  within  the  center  16  cells.  Each  time  the  embedding 
process  takes  place,  assume  the  quatitization  levels  are  halved.  Under 
these  assumptions  the  embedding  process  can  be  easily  implemented  in 
hardware  with  shift  registers. 

To  see  this,  examine  Fig.  5-5.  Both  states  are  sampled  and  quantized  to 
10  bits  of  precision.  The  shift  registers  are  set  to  pass  the  four  most 
significant  bits  to  the  PROM  which  stores  the  control  law.  As  the  state 
is  driven  towards  the  center^  of  the  state  space,  the  most  significant  bits 
of  and  X2  are  zeroed  out.  (If  the  A/D  converters  output  numbers  in 

two's  compliment  format,  then  the  most  significant  bits  become  either 
zeros,  for  positive  numbers,  or  ones,  for  negative  numbers.  In  either 
case  the  circuit  could  tell  when  the  system  is  approaching  the  center 
cells  by  exclusive-oring  the  most  significant  bits  of  X.j  and  X^.)  When 

the  two  most  significant  bits  of  both  X.|  and  X^  are  all  zeros  or  ones, 

then  the  Shifter  Control  Unit  will  instruct  each  register  to  shift  right 
one  bit.  That  is,  bits  b^  -  b^  of  X.^  and  X^  are  used  to  drive  the  PROM 

instead  of  bits  bQ  -  b^.  This  is  equivalent  to  scaling  each  state 

quatization  level  by  one  half.  The  shift  register  to  the  right  of  the 
PROM  will  appropriately  scale  the  input  to  the  system.  So,  the  grid 
embedding  process  can  be  easily  implemented  using  a  simple  shifting 
technique. 

It  can  be  shown,  [3],  that  the  same  control  PROM  can  be  used  before  and 
after  embedding.  Thus,  a  PROM  which  contains  256  words  is  sufficient  for 
this  controller.  Also,  the  shifter  control  unit  should  be  designed  to 
continously  monitor  all  the  bits  coming  out  of  the  A/0  converters.  This 
is  needed  for  the  following  situation.  Suppose  a  disturbance  is 
encountered  which  will  drive  the  state  outside  the  bounds  of  an  embedded 
grid.  If  the  controller  can  detect  this  situation,  it  can  expand  the  grid 
(by  shifting  left)  to  an  appropriate  size  to  capture  the  disturbance,  and 
then  precede  as  normal . 

5.1.6.  Non-Linear  Systems. 

In  the  development  of  this  theory  we  explicitly  assume  that  the  system  to 
be  control  is  linear.  However,  this  is  not  necessary.  We  can,  with  only 
a  slight  modification,  use  the  theory  on  non-linear  systems.  The  states 
still  can  be  discretized  and  the  digital  model  found  by  tracing  the 
transition  of  the  center  of  each  cell.  Furthermore,  the  optimal  spanning 
tree  algorithm  makes  no  assumption  about  the  graph  it  is  being  applied 
to.  The  only  change  which  is  necessary  for  non-linear  systems  exist  in 
the  grid  embedding  technique.  For  the  non-linear  systems,  a  new  control 
law  (PROM)  may  have  to  be  switched  in  each  time  the  embedding  process  is 
done. 
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Unit 


5.1.7.  Example. 

This  control  algorithm  has  been  applied  to  the  following  system,  in  which 
the  state  x(t)  is  to  be  regulated  to  the  zero  state. 


x(t)  = 


*0.0  l.o" 

x(t)  + 

’  0 

u 

0.0  -10. 9_ 

10.9 

(5-15) 


We  choose: 


T  = 

0.1 

sec 

*1  = 

2ir/32 

!  rad 

(5-16) 

^2  = 

1.5 

rad/sec 

y  = 

1 .25 

volts 

and  impose  the  following  bounds  on  the  states  and  inputs: 

Ix^l  < 

ir 

rad 

IX2I  < 

12 

rad/sec 

(5-17) 

Iu|  < 

10 

volts 

the  digital  model  for  this  system  was  derived,  and  using  the  "optimal 
spanning  tree"  algorithm  with  the  following  weights: 


Cjj  =  U(k)2 

Cj^  =  2(x^(k)2  +  x^Ck)^) 


(5-18) 


the  control  law  was  developed.  The  embedding  process  was  designed  to 
proceed  whenever  the  system  is  in  any  of  the  32  center  cells. 

Figure  6  illustrates  the  simulated  runs  of  this  digital  control  strategy. 
For  comparision,  the  trajectory  for  an  optimal  linear  regulator  using 
continuous  state  feedback  is  included.  The  performance  index  used  for  the 
continuous  controller  is  given  by 
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(5-19) 


J  =  ;  (U(t)‘  +  2x^(t)‘  +  2X2(1)  )dt 
0 

which  roughly  approximates  the  weighting  scheme  used  for  the  controller 
derived  from  the  digital  model.  Two  strategies  yield  similar  results. 


0.25  0.75  1.25  1.75 

TIME  CSECS> 


Figure  5,6.  Simulated  System 


5.2.  User  Manual  for  the  Program  ”DTQD" 


5.2.1.  Introduction. 

The  program  "DTQD"  Is  an  aid  in  developing  controllers  for  discrete-time 
quantized  data  (DTQD)  systems. 

"DTQD"  is  a  menu-driven  program  with  a  hierarchial  structure.  It  is 
divided  into  six  basic  parts,  each  being  described  in  the  following 
sections.  A  command  level,  the  main  menu,  is  used  to  access  each  of  the 
five  other  levels:  Initialization,  pararmeter  modification,  display, 
control  law  development,  and  simulation. 

The  program  is  coded  in  PL1.  It  was  designed  to  be  run  on  Honeywell  68- 
DPS-2  MULTICS  system  computers,  but  without  serious  modifications  could  be 
implemented  on  any  system.  The  user  need  only  type  "DTQD"  to  execute  the 
program.  The  program  starts  out  at  the  initialization  sub-level  and 
proceeds  to  the  command  level  after  the  job  has  been  designated.  From  that 
point  on,  the  user  has  control  and  may  go  to  any  of  the  five  sub-levels. 

The  status  of  the  current  "job"  is  monitored  by  five  flags.  When  a  flag  is 
set  it  indicates  that  that  part  of  the  job  has  been  developed.  The  five 
flags  designate  whether  or  not  a  continuous-time  and/or  a  discrete-time 
model  of  the  system  exists,  whether  a  quantized  model  exists,  if  a  control 
law  has  been  developed,  and  whether  or  not  a  file  containing  a  simulation 
of  the  controlled  system  has  been  made. 

During  the  run,  the  user  may  be  asked  to  input  three  different  types  of 
responses:  a  yes/no  answer,  a  number  from  a  multiple  choice  menu,  and 
numerical  data.  If  a  yes/no  answer  is  required,  the  following  are 
acceptible  answers:  "y",  "yes",  or  "n",  "no".  If  a  choice  from  a  menu  is 
requested,  only  an  integer  is  considered  a  proper  response.  Finally,  when 
inputting  a  numerical  piece  of  data,  only  numbers,  decimal  points,  and 
minus  signs  are  acceptible.  In  case  of  a  mistake,  MULTICS  allows  a  "#" 
sign  to  "erase"  the  previous  character  inputted,  and  a  "@"  sign  to  "erase" 
the  entire  line. 

5.2.2,  Initialization. 

The  first  menu  displayed  is  the  initialization  menu.  It  gets  the  user  to 
open  a  data  file.  This  may  be  a  new  file,  an  old  file,  or  the  user  may 
wish  to  take  the  data  from  an  old  file  and  copy  it  into  a  new  file  and  work 
with  the  new  file.  The  data  file  is  referenced  by  a  "job"  name.  This  name 
may  be  any  one  word  with  a  maximum  length  of  50  characters,  and  is  inputted 
by  the  user.  It  may  be  any  combination  of  numbers,  letters,  and 
underscores;  however,  the  first  character  must  be  a  letter  ("$"  is 
considered  to  be  a  letter)  and  the  name  may  not  contain  blanks  or  periods 
(.).  The  job  name  will  also  reference  all  other  files  made  concerning  the 
job:  the  quantized  data  file,  also  called  the  next-state  file,  which 
contains  the  coded  version  of  how  each  state  is  affected  by  each  input  (See 
section  5.2.M.13.  for  coding  procedure),  the  control  law,  and  the 
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simulation  file.  The  inital ization  menu  appears  as  follows: 

1.  Access  an  old  job  file 

2.  Create  a  new  job  file  (init.  menu) 

3.  Modify  an  old  job  file 

4.  Quit 

5. 2. 2.1.  Open  an  old  file.  If  a  "1"  is  entered,  the  user  is  prompted  to 
enter  a  job  name.  The  data  file  job_name.DATA  is  accessed.  If  the  flag 
which  monitors  the  existence  of  a  quantized  model  is  set,  but  a  file 
containing  the  model  does  not  exist,  the  program  proceeds  to  automatically 
build  the  next  state  array.  If,  however,  the  quantized  model  does  exist  in 
a  file,  that  file  is  accessed  in  addition  to  the  data  file.  Similarly,  if 
the  control  flag  is  set,  the  program  accesses  the  file  containing  the 
control  law.  After  completing  this  process,  the  Main  Menu  appears  and  the 
user  is  at  the  Command  level. 

5. 2. 2. 2.  Open  a  new  file.  The  program  prompts  the  user  for  a  job  name  and 
then  a  title  for  the  data  file.  The  title  may  consist  of  up  to  70 
characters.  However,  if  it  is  made  up  of  more  than  one  word  it  needs  to  be 
entered  within  quotation  marks  (").  The  user  is  then  sent  to  the 
parameter  modification  level.  (See  section  5.2.4.)  At  that  level  the  user 
is  prompted  to  enter  any/all  of  the  parameters  concerning  the  model  of  the 
system  and  the  A/D  converter.  After  the  models  have  been  built  the  user  is 
sent  to  the  Command  level. 

5. 2. 2. 3.  Copying  an  old  file  into  a  new  file.  By  entering  a  "3"  tne  user 
is  able  to  access  an  old  file,  copy  the  data  file  from  it  into  a  new  file, 
and  work  with  the  new  file.  In  this  way  the  user  may  modify  existing  data 
and  yet  not  destroy  the  original  data.  The  user  must  enter  the  job  name  of 
the  old  file  and  then  a  new  name  for  the  new  file.  The  program  then 
proceeds  as  in  case  (1)  above  (accessing  an  old  file)  by  building  or 
opening  the  files  containing  the  quantized  model  and  the  control  law  if  the 
status  flags  are  set, 

5. 2. 2. 4.  Quit.  If  a  "4"  is  entered  it  is  assumed  that  the  user  does  not 
want  to  initialize  a  new  job,  and  the  user  is  sent  to  the  command  level. 

5.2.3.  Command  Level. 

The  Command  Level  is  primarily  the  "main  menu"  which  consists  of  the 
following  options: 

1.  Initialize 

2.  Modify  Data  File 
3-  Print  files 

4.  Develop  Control  Law 

5.  Simulate  (main  menu) 

6.  Quit 

5. 2. 3.1.  Initialize.  This  level  allows  the  user  to  choose  a  different  job 
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file  to  work  with.  (See  section  5.2.2.)  Thus,  the  user  is  essentially  re- 
executing  the  program.  Before  re-starting  the  initialization  process,  all 
modifications  to  the  current  job  are  saved  and  the  data  file  is  closed. 

5. 2. 3. 2.  Parameter  modification.  At  this  level  the  user  is  able  to  modify 
any  of  the  parameters  in  the  data  file:  the  continuous-time ,  discrete¬ 
time,  or  quantized  system  parameters.  (See  section  5.2.4.) 

5.2.3.3.  Display.  This  response  allows  the  user  to  examine  other  files 
(See  section  5.2.5.)  The  display  level  is  entered,  and  the  user  can  look 
at  the  data  in  the  job  file  as  well  as  the  next-state  array,  and/or  the 
control  law.  The  status  of  the  job,  and  a  summary  of  the  quantization 
levels  can  also  be  examined. 

5. 2. 3. 4.  Control  law.  This  choice  executes  the  control  law  development 
level  (See  section  5.2.6.) 

5. 2. 3. 5.  Simulate.  This  selection  simulates  the  controlled  system  (See 
section  5.2.7.) 

5. 2. 3. 6.  Quit.  This  choice  ends  the  program.  If  a  quantized  model  of  the 
system  exists  for  the  job,  the  user  can  save  this  model  in  a  file.  The 
status  flag  for  the  quantized  model  is  not  affected  by  this  decision.  If 
the  data  is  not  saved,  then  the  next  time  the  job  is  accessed,  the 
quantized  model  will  be  automatically  rebuilt  instead  of  read  in  from  the 
file.  Finally,  all  files  are  closed  and  the  program  is  exited. 

5.2.4.  Parameter  Modification. 

This  level  may  be  accessed  via  the  command  level  or  by  the  initialization 
level  if  a  new  job  is  created.  The  parameter  modification  level  is  made  of 
three  sub-levels,  each  accessing  even  further  sub-levels.  The  user  may 
enter  or  modify  the  continuous-time  model  for  the  system.  The  program  can 
then  generate  a  discrete-time  model  or  allow  the  model  to  be  entered  by  the 
user.  Similarly,  the  quantized  model  may  be  generated  or  a  file  containing 
the  quantized  model  may  be  accessed. 

When  the  continuous  system  is  modified,  the  discrete  and  quantized  models 
are  no  longer  valid  and  so  their  status  flags  are  cleared.  Similarly,  the 
control  law  and  simulations  can  no  longer  be  associated  with  the  model  and 
their  status  flags  are  also  cleared.  This  process  is  continued  throughout 
the  program:  when  a  model  or  file  is  modified,  all  models  and  files 
generated  from  it  are  invalid  and  hence  their  status  flags  are  cleared. 

Upon  entering  this  level,  the  following  may  be  modified  or  created. 

1.  Title  of  the  job  file 

2.  Continuous  system  parameters 

3.  Discrete  system  parameters  (param  menu) 

4.  Quantized  system  parameters 

5.  None  of  the  above 
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5. 2. 4.1.  Title.  The  user  is  prompted  to  enter  a  title.  It  can  have  a 
length  of  up  to  70  characters;  however,  if  it  is  more  than  one  word  it  must 
be  entered  inside  quotation  marks  (")• 

5. 2. 4. 2.  Continuous  parameters.  As  soon  as  a  continuous  model  of  the 
system  is  created  or  modified,  the  status  flags  for  the  discrete-time  and 
quantized  models,  the  control  law,  and  any  simulations  are  cleared.  If  a 
continuous  system  already  exists,  the  user  may  choose  the  parameters  which 
need  to  be  modified. 

1.  Number  of  states 

2.  Number  of  inputs 

3.  System  matrix,  A  (param.2  menu) 

4.  Input  matrix,  B 

5.  All  of  the  above 

6.  None  of  the  above 

This  menu  will  continue  to  re-appear  until  a  "6"  is  entered.  If  a 
continuous  system  does  not  currently  exist,  this  menu  does  not  appear;  it 
is  assumed  that  the  user  wishes  to  enter  all  of  the  parameters  (i.e,  that  a 
"5"  was  entered). 

5. 2. 4. 3.  Number  of  states.  The  user  is  asked  to  enter  the  number.  It 
must  be  an  integer  and  have  a  value  no  larger  than  ten.  Since  the  number  of 
states  affects  the  dimensions  of  the  system  and  input  matricies,  the  user 
is  also  prompted  to  enter  all  of  the  components  of  each  of  these  matricies. 
The  above  menu  (param.2)  is  then  re-displayed  so  that  other  changes  may  be 
made  if  desired. 

5. 2. 4. 4.  Number  of  inputs.  The  number  of  inputs  must  be  an  integer.  As 
in  the  above  case,  a  change  in  the  number  of  inputs  will  cause  a  change  in 
the  dimensions  of  the  input  matrix,  B.  For  this  reason,  the  user  is  then 
automatically  asked  to  enter  the  entire  B  matrix. 

5. 2. 4. 5.  System  matrix.  The  program  prompts  the  user  to  enter  the  A 
matrix.  After  entering  all  the  components,  the  above  menu  (param.2)  is 
again  displayed. 

5. 2. 4. 6.  Input  matrix.  As  in  the  above  case,  the  program  prompts  the  user 
to  enter  each  element  of  the  input  matrix,  B. 

5. 2. 4. 7.  Modify  all.  The  user  is  prompted  to  enter  all  of  the  above 
parameters  in  the  order  in  which  they  appear  in  the  menu  param.2.  After 
entering  the  data,  the  menu  is  displayed,  giving  the  user  an  opportunity  to 
re-modify  any  of  the  new  data  in  case  a  mistake  was  made. 

5. 2. 4. 8.  Modify  none.  If  a  "6"  is  entered  it  is  assumed  that  the  user  has 
completed  all  the  desired  modifications  of  the  continuous-time  system.  The 
user  is  returned  to  the  (param)  menu  and  can  modify  or  create  another  model 
of  the  system. 
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5. 2. 4. 9.  Discrete  parameters.  If  the  user  wishes  to  modify  or  create  the 
discrete-time  parameters,  a  "3"  should  be  entered  when  the  menu  (param)  is 
displayed.  Upon  generating,  creating,  or  modifying  the  discrete  model,  the 
quantized  model,  control  law,  and  simulation  status  flags  are  deleted  for 
the  current  job.  If  a  continuous  model  of  the  system  exists  the  user  can: 

1.  Generate  a  discrete  model  from  the  continuous  model 

2.  Modify  the  discrete  model 

3-  Quit  (param. 3a  menu) 

If,  however,  a  continuous  model  does  not  currently  exist,  the  following 
menu  is  displayed: 

1.  Create  a  continuous  model  first 

2.  Modify/Create  a  discrete  model 

3.  Quit  (param. 3b  menu) 

5.2.4.10.  Discrete  model  generation.  If  a  continuous  -  time  model  exists, 
the  user  is  asked  to  enter  the  time  constant  tau,  and  then  the  program  will 
automatically  discretize  the  continuous  model  and  display  the  new  discrete¬ 
time  system  and  input  matrlcies.  If,  on  the  other  hand,  a  "1"  is  entered 
when  menu  (param. 3b)  is  displayed,  the  program  will  prompt  the  user  for  the 
continuous  -  time  parameters.  Thus,  the  user  is  sent  to  another  level,  and 
is  then  able  to  enter  the  continuous  system. 

5.2.4.11.  Discrete  model  modification.  A  di scr ete-time  model  of  the 
system  may  be  entered  Independently  from  the  continuous  model.  Caution:  If 
this  is  done  when  the  menu  (param. 3a)  had  been  displayed,  (i.e,  when  a 
continuous  system  exists)  the  user  will  be  making  the  continuous  model 
invalid  since  it  will  no  longer  represent  the  same  system. 

The  user  is  asked  to  select  the  parameters  to  be  modified. 


1 .  Number  of  states 

2.  Number  of  inputs 

3.  Discrete  system  matrix  (param. 3.1  menu) 

4.  Discrete  input  matrix 

5.  All  of  the  above 

6.  None  of  the  above 

This  menu  is  very  similar  to  menu  (param.2)  for  the  continuous-time  case; 
thus,  a  description  is  omitted  here. 

5.2.4.12.  Quit.  This  entry  will  cause  the  menu  (param)  to  be  displayed. 

5.2.4.13.  Quantized  parameters.  There  are  two  methods  of  obtaining  a 
quantized  model  of  the  system.  When  a  new  model  is  generated  or  accessed, 
the  control  law  and  simulation  status  flags  are  automatically  cleared. 

If  a  discrete  model  of  the  system  exists,  the  user  may  generate  a  quantized 
system  from  the  discrete  model.  The  following  parameters  of  the  A/D 
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converter  must  be  entered;  the  number  of  quantization  steps  for  each  state, 
the  upper  and  lower  voltage  bounds  for  each  state,  the  number  of 
quantization  steps  for  each  input,  and  the  upper  and  lower  voltage  bounds 
for  each  input.  If,  on  the  other  hand,  the  user  does  not  want  the 
quantized  system  generated,  a  separate  file  which  already  contains  a 
quantized  model  of  the  system  can  be  accessed.  If  a  discrete  model  of  the 
system  does  exist  and  the  user  accesses  this  file,  the  discrete  model  may 
no  longer  be  valid. 

If  a  discrete  model  does  not  exist,  the  user  can  create  one  or  access  a 
separate  file  containing  a  quantized  model  of  the  system.  If  it  is  desired 
to  create  a  discrete  model,  the  menu  (param)  appears.  The  user  may  then 
input  a  "3"  and  begin  to  generate  or  create  a  discrete-time  model.  If  the 
user  wishes  to  access  a  file  containing  the  quantized  system  (i.e,  a  next- 
state  file  containing  the  affects  of  each  input  on  each  state),  the  program 
asks  for  the  name  of  the  data  file. 

After  modifying,  creating,  or  generating  the  quantized  model  of  the  system, 
the  user  can  have  the  next-state  array  displayed.  (See  section  5. 2. 5. 3-) 
The  states  and  inputs  are  each  coded.  The  codes  are  used  throughout  the 
program  and,  more  importantly,  are  used  to  represent  the  states  and  inputs 
when  printing  out  the  next  -  state  array,  the  control  law,  and  cell  status 
array.  The  states  and  inputs  are  coded  in  the  following  manner:  the 
smallest  possible  state  has  a  code  of  1;  the  first  state  is  increased  to 
its  next  possible  value  and  then  coded  with  a  2;  the  first  state  continues 
to  be  incremented  until  it  reaches  its  largest  possible  value  minus  one 
step.  Next,  the  second  state  is  incremented  by  one  step  and  the  process  is 
repeated.  The  coding  continues  until  all  possible  state  combinations  have 
been  coded.  The  procedure  for  coding  the  inputs  is  similar. 

5.4.4,14,  Example  1:  Coding  the  states  and  inputs.  Assume  that  the  user 
inputs  the  following  A/D  parameters: 

number  of  states  =  2; 
number  of  inputs  =  1 

number  of  quantization  steps  for  state  1  =  4 
number  of  quantization  steps  for  state  2=8 
upper  and  lower  voltage  bounds  for  state  1  =4,  -4 
upper  and  lower  voltage  bounds  for  state  2  =  2,  -2 
number  of  quantization  steps  for  the  input  =  4 
upper  and  lower  voltage  bounds  for  the  input  =1,-1 

Now,  the  program  can  code  the  states  and  inputs  in  the  following  manner: 

number  of  state  combinations  =  4  x  8  =  32 

the  step  size  for  state  1  =  (  4  -  (-4)  )  /  4  =  2 
the  step  size  for  state  2  =  (  2  -  (-2)  )  /  8  =  0.5 
number  of  input  combinations  =  4 

the  step  size  for  the  input  =  (1  -  (-1)  )  /  4  =  0.5 

Thus,  there  are  32  state  codes  and  4  input  codes. 
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The  smallest  possible  state  = 


-1* 

-2 


Increasing  state  1  by  1  step  size  = 


Similarly,  the  code  for 


Note  the  case  of 


4 

-2 


0 

1-2  j 


=  3  , 


-2 

-2 


it  has  a  state  code  of  1 

it  has  a  state  code  of  2 


4  . 


is  not  included;  the  process  codes  the  states  from 


lower  voltage  level  to  the  (upper  voltage  level  -  1  step). 


Next,  the  process 
one  step.  Thus 


_ is  cepeated  after  first  incrementing  the  second  state  by 


-4 

■1.5 


has  a  code  of  5, 


-2 

-1.5 


has  a  code  of  6 


The  process  continues  until  finally. 


2 

1  .5 


has  a  code  of  32. 


The  quantized  model  of  the  second  order  system  may  be  thought  of  as  a  cell 
plane,  with  first  state  along  the  horizontal  axis  and  the  second  state 
along  the  vertical  axis.  The  two  cell  planes  for  this  example  (See  Figure 
2-1)  graphically  illustrate  the  discrete  states  and  their  codes.  A  similar 
process  is  used  to  code  the  inputs. 


5.2.4.15.  Quit.  This  selection  returns  the  user  to  the  command  level. 
5.2.5.  Display  Level. 


At  this  level  the  user  may  choose  to  have  any  of  the  following  displayed: 

1 .  Status  of  the  j ob 

2.  Data  file 

3.  Quantized  data  (next-state)  file 

4.  Summary  of  quantization  levels 

5.  Control  Law  (display  menu) 

6.  None  of  the  above 


The  above  menu  may  vary  depending  on  the  validity  of  the  files.  For 
example,  if  a  control  law  does  not  exist  yet  for  the  job,  choices  4  and  5 
are  omitted. 


5. 2. 5.1.  Check  status.  This  option  allows  the  user  to  see  which 
representations  of  the  system  are  valid:  the  continuous-time,  discrete¬ 
time,  and/or  the  quantized  model.  Also,  two  checks  are  made  to  see  whether 
or  not  a  control  law  exists  for  the  job  and  if  a  file  containing  simulation 
data  exists. 


5. 2.5.2.  Data  file.  This  choice  tells  the  program  to  display  the 
continuous-time,  discrete-time,  and  the  A/D  converter  parameters.  (Note: 
at  the  present  time  this  option  does  not  work.) 

5. 2. 5. 3  Next-state  array.  The  next-state  array  is  two  dimensional,  and 
displayed  such  that  the  code  for  each  state  is  on  the  vertical  "axis"  and 
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Figure  5-7.  Quantization  Grids 
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the  code  for  each  input  is  printed  along  the  horizontal.  Lying  within  the 
matrix  are  the  codes  representing  the  states  to  which  the  corresponding 
state  would  move,  given  the  corresponding  input.  The  coding  procedure  is 
discussed  is  section  5.2.4.13.  If  the  code  is  a  zero  (0),  it  implies  that 
the  given  state  is  saturated  or  leads  to  a  uncontrollable  cell.  An 
uncontrollable  cell  is  one  which  leads  to  a  saturated  state  for  all 
possible  inputs.  After  printing  the  next  state  array  for  ten  states  the 
user  is  given  the  option  to  continue  displaying  the  array.  This  question 
is  asked  after  every  ten  states. 

5. 2. 5. 4.  Example  2:  Format  of  next-state  arrays.  The  next  state  array  is 
a  two-dimensional  array  of  dimension  number  of  state  combinations  by  number 
of  input  combinations.  If  the  user  enters  the  A/D  parameters  as  described 
in  Example  1  ,  the  first  part  of  the  quantized  data  array  could  appear  as 
follows : 


1 

9 

9 

17 

17 

2 

10 

10 

18 

18 

3 

0 

0 

0 

0 

4 

12 

12 

20 

20 

32 

17 

17 

9 

9 

In  this  example,  as  in  example  1  of  section  5.2.4.14.,  there  are  32  state 
combinations  and  4  input  combinations.  The  first  row  of  the  array  tells 
the  user  that  if  the  current  state,  x(k),  has  a  code  of  1  and  an  input  is 
applied  which  has  a  code  of  1  or  2,  then  the  next  state,  x(k+1),  will  have 
a  state  code  of  9.  Similarly,  if  an  input  is  applied  whose  code  is  3  or  4, 
the  next  state's  code  will  be  17.  Any  input  will  cause  the  third  cell  to 
saturate  or  become  uncontrollable. 

5. 2. 5. 5.  Check  quantization  level.  This  option  allows  the  user  to  make 
some  crude  checks  regarding  the  quantization.  Two  basic  checks  are  done. 
The  first  is  a  summary  of  the  cells  moved  from  each  state  with  a  zero 
input.  The  number  of  cells  moved  in  each  direction  and  the  total  number  of 
cells  moved  are  computed  and  displayed. 

The  second  part  of  the  report  checks  the  number  of  cells  moved  from  the 
zero  state  for  each  input  at  its  smallest  value.  If  the  smallest  value 
results  in  saturation,  the  smallest  value  which  results  in  a  non-saturated 
next  state  is  used.  The  results  are  reported  for  each  input.  In  this 
part,  unlike  the  first,  the  cell  movement  is  described  by  an  absolute  and 
average  value.  The  absolute  value  represents  the  number  of  cells  moved  in 
the  given  direction,  while  the  average  value  is  the  ratio  of  the  number  of 
cells  moved  to  the  number  of  steps  between  the  smallest  non  saturating 
input  and  the  zero  input.  These  absolute  and  average  values  are  recorded, 
as  in  the  first  part,  for  cell  movements  in  each  direction  as  well  as  the 
total  number  of  cells  moved.  (See  Example  in  section  5. 2. 5. 6.) 

After  displaying  the  summary,  the  user  has  the  option  to  have  the 
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saturation  edge  array  printed.  This  array  has  the  same  matrix  format  as 
the  next  state  array,  but  elements  are  displayed  as  either  an  "F"  or  a  "T." 
A  "T"  is  displayed  if  the  cell  leads  to  saturation  or  to  an  uncontrollable 
cell  when  the  corresponding  input  is  applied.  For  instance,  if  the 
beginning  of  the  array  appears  as: 

1  F  F  F  F 

2  T  F  F  F 

3  T  T  T  T 

4  F  F  F  F 

it  implies  that  any  input  will  cause  the  state  whose  code  is  3  to  lead  to 

saturation  or  to  an  uncontrollable  cell.  This  result  also  occurs  if  an 
input  which  has  a  code  of  1  is  applied  to  state  code  2. 

If  some  of  the  cells  are  uncontrollable,  the  user  has  the  opportunity  to 
print  out  the  uncontrollable  cell  array.  This  array  contains  the  codes  of 
the  cells  which  are  uncontrollable. 

5. 2.5.6.  Example  3:  Calculation  of  cell  movement.  Using  the  second  cell 
plane.  Figure  5-7,  assume  that  the  state  with  a  code  of  10  moves  to  the 
state  coded  by  19  when  the  zero  input  is  applied.  The  movement  in  the 
direction  of  the  first  state  (horizontal  movement)  is  1  cell  and  the 
movement  in  the  second  direction  is  2  cells.  Thus,  the  total  number  of 
cells  moved  is  1  +2=3  cells. 

From  Example  1  of  5.2.4.14.,  the  zero  state  has  a  code  of  19,  and  the  zero 
input  has  a  code  of  3.  Assume  that  the  smallest  input  (-1  volts)  leads 
the  zero  state  into  saturation  but  the  next  smallest  input  (-0.5  volts) 
leads  the  zero  state  to  the  state  whose  code  is  15.  The  number  of  steps 
between  the  zero  input  and  the  minimum  non-saturating  input  is  one,  since 
there  is  only  one  step  between  0  and  -0.5.  The  absolute  movement  then,  is 
0  cells  in  the  direction  of  state  1  and  is  1  cell  in  the  direction  of  state 
2.  The  average  movement  is  0/1  =  0  cells  in  direction  1,  and  1/1  =1  in  the 
second  direction. 

5. 2. 5. 7  Control  law  file  display.  The  control  law  file  for  the  job  is 
printed.  The  display  is  an  array  giving  the  appropriate  input  code  for 
every  possible  state  combination  to  obtain  the  desired  controller.  (See 
section  5.2.4.14.  for  an  explaination  and  example  of  the  coding  process.) 

5. 2. 5. 8  Quit.  This  choice  causes  the  program  to  exit  the  display  level 
and  return  to  the  command  level. 

5.2.6.  Control  Law  Development. 

Upon  entering  this  level,  the  user  is  asked  to  enter  the  type  of  cost 
function  to  be  used  in  developing  the  control  law. 

1 .  Minimum  Time 

2.  Quadratic 
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3.  Minimum  Control  Effort 

4.  Custom  Cost  Function  (control  menu) 

5.  None  -  Access  a  control  law  file 

6.  None  of  the  above 

5. 2. 6.1.  Minimum  time.  The  program  attempts  to  build  a  control  law  which 
satisfies  the  requirements  of  a  minimum  time  cost  function.  Thus,  the 
controller  will  be  one  such  that  the  control  input  will  take  the  current 
state  to  the  origin  in  the  least  amount  of  time. 

5. 2. 6. 2.  Quadratic.  If  this  cost  function  is  chosen  the  user  is  asked  to 
enter  the  state  and  input  cost  matricies  (the  "Q"  and  "R"  matricies).  These 
weighting  matricies  are  assumed  to  be  diagonal,  so  only  the  diagonal 
elements  are  needed. 

5. 2. 6. 3.  Minimum  control  effort.  As  in  the  case  above,  the  user  is  asked 
to  enter  the  input  weighting  matrix  ("R").  Again,  this  is  assumed  to  be  a 
diagonal  matrix. 

5. 2. 6. 4.  Custom  cost  function.  If  none  of  the  above  choices  are 
desirable,  the  user  may  write  a  custom  cost  function.  To  do  this,  a 
procedure  should  be  written  in  PLl  and  named  custom  cost  function.  The 
discrete  state  and  input  arrays  are  passed  to  custom_cost_function  and  the 
procedure  should  compute  and  return  the  cost.  All  three  parameters  need  to 
be  declared  as  floating  arrays/numbers. 

5. 2. 6. 5.  Access  a  file.  The  user  may  choose  to  implement  an  already- 
developed  control  law  by  entering  the  name  of  the  file  so  that  the  program 
can  access  it. 

5. 2. 6. 6.  Quit.  This  is  the  correct  choice  if  the  user  does  not  wish  to 
build  a  control  law,  but  does  want  to  return  to  the  command  level. 

After  choosing  the  cost  function  (if  a  "6"  was  not  chosen),  the  user  is 
prompted  to  enter  the  center  and  edge  cell  tolerances.  The  center  cell 
tolerance  is  used  by  the  program  to  determine  the  tolerant  region  which 
surrounds  the  origin.  Within  this  tolerant  region,  the  program  checks  to 
see  if  any  cells  exist  which  can  not  reach  the  origin  with  any  of  the 
possible  inputs,  yet  other  cells  which  are  also  unable  to  get  to  the  origin 
are  able  to  reach  them.  These  cells  are  called  root  cells.  So,  if  a 
center  cell  tolerance  of  1  is  entered  for  the  system  discussed  in  Example 
1,  the  program  would  check  to  see  if  any  of  the  following  cells  were  root 
cells:  1  4,  1  5,  1  6,  1  8,  20,  22,  23,  and  24. 

The  edge  cell  tolerance  is  used  to  compensate  for  edge  irregularities.  If 
this  tolerance  is  input  to  be  1  ,  f or  the  system  described  in  5.2.4.14., 
the  edge  cells  would  be:  1  -  4,  5,  8,  9,  1  2,  1  3,  1  6,  1  7,  20,  21,  24,  25, 
28,  and  29  -  32.  Both  the  center  and  edge  cell  tolerances  must  be  entered 
as  integers. 

The  program  continues  by  attemting  to  build  the  cell  status  array;  it  finds 
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all  root  cells  and  the  cells  which  are  reachable  to  them.  If  successful, 
the  tolerant  region  is  built.  If  the  tolerant  region  control  law  can  be 
constructed,  the  program  then  builds  the  control  law  and  sets  the  control 
law  status  flag. 

If  the  status  flag  for  the  control  law  is  set,  the  user  can  have  the  cell 
status  array  and  control  law  printed.  The  cell  status  array  is  an  array 
which  codes  each  state  in  the  following  manner: 

0:  Unmarked  cell 

1:  Cell  is  uncontrol  lable 

2:  Cell  is  in  the  edge  tolerant  region 

3:  Root  Cell  -  the  zero  state  cell 

4:  Cells  which  can  reach  the  Root  cell  coded  with  a  3 
5:  Root  Cell 

6:  Cells  which  can  reach  the  root  cell  coded  with  a  5 

7:  Root  cell 

8:  Cells  which  can  reach  the  root  cell  coded  with  a  7 


i :  Root  Cel  1 

i+1 :  Cells  which  can  the  root  cell  coded  with  an  "i" 

The  control  law  is  printed  out  just  as  in  the  Display  level  (See  section 

5. 2. 5. 7. )  The  appropriate  input  code  which  has  been  found  to  satisfy  the 
chosen  cost  function  is  printed  for  each  state  code. 

5.2.7.  Simulation  Level. 

After  the  control  law  has  been  developed  for  the  job,  the  user  may  wish  to 
simulate  the  controlled  system.  To  simulate  the  system,  the  program  calls 
an  IMSL  routine,  DVERK,  which  solves  the  system  of  differntial  equations  or 
0WN_SYS_T0_SIM  if  a  system  other  than  the  one  in  the  job  file  is  to  be 
simulated.  A  simulation  of  the  system  may  only  be  obtained  after  the 
parameters  for  the  quantized  system  have  been  entered  and  a  control  law  has 
been  developed. 

Upon  entering  this  level,  the  following  menu  or  question  is  displayed, 
depending  whether  or  not  a  simulation  file  exists  for  the  current  job: 

If  a  simulation  does  not  exist: 

Would  you  like  to  simulate  the  system? 

If  a  simulation  file  does  exist: 

Would  you  like  to: 

1.  Modify  the  simulated  data  file 

2.  Plot  the  existing  simulated  data  (Sim.  menu) 

3.  Quit 

5. 2. 7.1.  Simulating.  This  response  lets  the  user  start  the  simulation 
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process.  The  program  then  gives  the  user  various  parameters  needed  for  the 
simulation.  First,  the  user  can  have  any  continuous  model  of  the  system, 
not  necessarily  the  one  in  the  data  file,  be  simulated.  This  is  desirable 
if  the  user  wants  to  see  how  the  control  law  works  on  slightly  permutated 
systems.  With  this  option,  the  user  can  take  a  nonlinear  system,  find  a 
linear  representation  of  it  and  use  DTQD  to  develop  the  control  law,  and 
then  simulate  the  nonlinear  model  using  this  control  law.  If  this  is 
desired,  the  user  must  write  a  PL1  routine,  and  name  it  own_sys_to_sim.pl  1 . 
Note:  the  states  to  be  accessed  by  the  control  law  must  be  the  first  states 
in  the  system  of  equations.  This  limitation  implies  that  the  number  of 
equations  in  own_sys_to_sim  be  equal  or  greater  than  the  number  of  states 
used  in  the  development  of  the  job  file.  The  procedure  own_sys_to_sim 
should  have  the  following  parameters: 

num_of_equattons  -  fixed  binary  (35)  -  the  number  of  simultaneous 
differential  equations  to  be  solved  (i.e.  the  number  of  states); 
time  -  float  binary  -  the  current  time; 

time_end  -  float  binary  -  the  time  after  doing  subroutine; 
state  -  (10)  float  binary  -  the  state  array  upon  entering  routine; 
state_after  -  (10)  float  binary  -  the  state  array  after  subroutine; 
time_init  -  float  binary  -  the  initial  time  for  the  entire  simulation; 
time_end  -  float  binary  -  the  final  time  of  the  simulation; 

It  should  also  call  a  subroutine  which  will  determine  the  next  state, 
(e.g.  DVERK)  Whether  or  not  the  user  accesses  a  separate  file,  the  user 
is  asked  to  enter  the  number  of  steps  per  time  constant.  This  number 
should  be  an  integer  and  not  zero.  At  each  step  the  program  will  call 
IMSL_DVERK  or  0WN_SYS_T0_SIM  and  have  the  next  state  determined.  In  this 
way  the  continuous-time  model  is  simulated  and  the  user  can  observe  what  is 
happening  between  sampling  intervals.  The  number  of  embedding  levels  must 
be  entered  next.  This  value  should  also  be  a  integer.  The  number  of 
embedding  levels  is  the  number  of  times  the  controller  is  allowed  to  "zoom 
in."  A  zero  (0)  should  be  entered  if  the  user  does  not  want  to  access  any 
other  levels.  If  an  integer  other  than  zero  is  entered,  the  user  is  asked 
to  enter  the  scaling  factor.  This  value  should  be  greater  than  zero  and 
less  than  or  equal  to  one.  The  program  progresses  to  a  different  region, 
j,  whenever  the  state  is  less  than  (the  upper  bound  for  the  state)  x  (scale 
factor)-),  or  greater  than  (the  lower  bound  for  the  state)  x  (scale 
factor )-J.  After  the  region  is  determined,  the  control  law  is  accessed  such 
that  each  of  the  control  law  inputs  are  also  "scaled  down"  into  the 
appropriate  region.  (See  section  5. 2. 7. 2.  for  an  example) 

Next,  the  user  can  have  the  simulated  data  displayed  while  running.  A 
response  of  "yes"  causes  all  the  simulation  data,  time,  states,  and  control 
inputs,  to  be  printed  on  the  screen.  If  at  any  time  during  the  simulation 
one  or  more  of  the  states  becomes  greater  than  its  upper  bound  or  less  than 
its  lower  bound,  the  simulation  is  ended  and  a  warning  appears  to  let  the 
user  know  that  system  has  gone  unstable.  Whether  the  simulation  is 
successful  or  not,  the  user  can  save  the  simulated  data  in  a  file  and  plot 
the  data.  If  the  data  is  saved  in  a  file,  it  may  opened  later  to  study  the 
data.  If  a  file  is  made,  the  simulation  status  flag  is  set. 
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5. 2. 7. 2.  Example  4:  Recursion  levels  and  scaling  factor.  Using  the  A/D 
parameters  of  Examples  1  and  2,  recall  that  in  the  previous  examples,  the 
voltage  bounds  for  each  state  were  as  follows: 

upper  and  lower  voltage  bounds  for  state  1  =  4,-4 
upper  and  lower  voltage  bounds  for  state  2  =  2,-2 

If  the  user  enters  "3"  for  the  number  of  recursion  levels,  and  0.1  for  the 
step  size,  the  program  will  "zoom  in"  whenever  the  first  state  becomes 
smaller  in  magnitude  than  (0.1  x  4)  =  0.4,  or  when  the  second  state  becomes 
smaller  in  magnitude  than  (0.1  x  2)  =  0.2.  If  the  states  become  smaller  in 
magnitude  than  0.04  or  0.02,  respectively,  the  controller  will  zoom  in  a 
second  time.  If  state  1  had  a  value  of  0.3,  smaller  than  0.4  but  greater 
than  0.04,  the  state  would  be  at  the  first  level.  The  control  law  would  be 
accesssed  as  if  the  state  had  a  value  or  3  instead  of  0.3,  the  control 
input  would  be  found,  and  then  scaled  down  to  size.  Thus,  if  the  control 
law  listed  5  volts  as  the  proper  input  for  a  state  of  3.  the  input  that 
would  be  used  would  be  0,5  volts. 

5. 2. 7. 3  Plotting.  If  a  simulation  file  exists  for  the  job,  a  plot  can  be 
made  immediately  after  entering  the  simulation  level.  Otherwise,  the  plot 
can  be  made  following  a  simulation.  Several  parameters  must  be  entered  if 
the  user  wishes  to  make  a  plot.  The  user  can  make  several  plots  on  top  of 
one  another.  Also,  any  state,  any  input,  or  the  time  can  be  plotted  on 
either  axis.  The  user  may  have  any  ascii  keyboard  character  symbolize  each 
data  point  or  may  opt  to  have  no  symbols  at  all.  If  symbols  are  used,  the 
user  may  or  may  not  choose  to  have  them  connected  by  vectors.  In  addition, 
the  user  may  have  the  graph  made  with  tick  marks,  a  dotted  grid,  or  a  solid 
grid.  Also,  a  title  and  axis  labels  may  be  entered.  These  labels  have  a 
maximum  length  of  25  characters.  Finally,  the  user  may  have  the  program 
automatically  scale  the  plot  or  opt  to  choose  and  enter  the  upper  and  lower 
bounds  for  each  axis. 

5. 2. 7. 4.  Quit.  The  user  returns  to  the  command  level  if  this  choice  is 
selected. 


5.2.8.  An  Overall  Example. 

As  an  example,  consider  a  d.c.  servomotor.  To  find  a  control  for  the 
motor,  the  program  DTQD  could  be  implemented  as  follows.  First,  a  linear 
model  of  the  system  must  be  developed  to  represent  the  motor.  For  this 
example,  we  will  use  the  f ol lowing,  second  order  system  as  the  model: 


x(t) 


0  (t) 

0  1 

0  (t)' 

+ 

0 

0  (t) 

0  -2 

0  (t) 

1 

u(t) 


(5-20) 


DTQD  can  now  be  used  to  determine  the  discrete-time  model  using  the  above 
model  and  a  chosen  time  constant  t.  (The  following  pages  contain  the 
actual  program  run.)  With  x  =  0.25  sec"^,  the  discrete-time  model  was 
found  to  be: 
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II 

+ 

X 

1 .00 

0.20 

0  (k) 

+ 

r  0.05 

u(k) 

(5-21) 

0.00 

0. 6  1 

1 - 

CD 

+  , 

1  0.39 

From  this  model,  the  user  can  make  a  quick  estimate  of  how  state  1  and  2 
are  related  by  looking  at  the  state  trajectories.  Assume  that  the  voltage 


If  x(0)  = 


0(0)' 

= 

o' 

,  then  from  (5-21)  x(l) 

fo.Bo" 

0(1) 

1  ^ 

2.44 

cells  in 

'the  direction  of  the  first  state  a 

The  initial  cel  1 


direction  of  the  second  state  (a  1:2  ratio).  Therefore,  an  estimate  for  an 
average  cell  movement  can  be  made.  Using  the  1:2  ratio  as  a  guide  and  the 
voltage  limits,  an  estimate  can  be  made  regarding  the  number  of  steps 
needed  for  quantizing  the  state  and  input. 


Using  16  steps  for  the  first  state,  8  steps  for  the  second  and  8  for  the 
input,  DTQD  can  be  implemented  to  determine  the  quantized  model.  Next,  the 
user  may  opt  to  have  DTQD  breifly  summarize  the  quantization  and  cell 
movement.  From  this  summary,  the  user  can  determine  whether  of  not  the 
initial  estimate  for  the  number  of  steps  was  satisfactory. 


After  the  user  is  satisfied  with  the  quantized  model,  a  control  law  for  the 
system  can  be  developed.  In  this  example  a  minimum  time  cost  function  was 
chosen.  Finally,  the  system  may  be  simulated. 


The  following  pages  contain  the  program  run  for  this  example.  An 
exclaimation  point  (!)  before  a  word  or  number  implies  that  the  entry  was 
input  by  the  user. 


!  DTQD 


uLo  you  i.iKe  co 


1.  Access  an 

al  d 

2.  Create  a 

new 

3.  Modify  an 

old 

4.  Return  to 

M  a  i 

Please  choose 

one 

Enter  name  of 

the 

Enter  a  title 

for 

Note:  Quotes 

are 

!  "This  is  an  EXA-^ 

'job  file 
job  file 
job  file 
n  Menu 

of  the  above  =>  ! 
new  job  file  =>  ! 


the  data  file 
r  ecu i r  ed  if  no  r» 
LE" 


2 

servo_rnotor 

han  one  word  is  used 


Which  of  the  following  would  you  like  to  mo d i f y / c r e a t e’ 

1.  Title  of  the  job  file 

2.  Continuous  system  parameters 
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3.  Discrete  system  oarameters 

4.  Quantized  system  parameters 

5.  None  of  the  above 

Please  choose  one  =>  !  2 


Enter 

number 

of  states 

A 

M 

Enter 

number 

of  inputs 

=  >  !  1 

Enter 

V  a  lues 

for  the 

A 

matrix 

A 

(  1/ 

1  )  =>  ! 

Q 

A 

(  1  / 

2)  =>  ! 

1 

A 

(  2/ 

1)  =>  ! 

0 

A 

(  2/ 

2)  =>  ! 

■ 

2 

Enter 

va lues 

for  the 

a 

matrix 

3 

(  1  / 

1  )  => 

1 

0 

3 

(  2/ 

1  )  => 

j 

1 

Which  parameter(s)  would  you  like  to  change? 

1.  Number  of  states 

2.  Number  of  inputs 

3.  System  matrix^  A 

4.  Input  matrix/  8 

5.  All  of  the  above 

6.  None  of  the  above 

Please  choose  one  =>  !  6 


Which  o^  the  following  would  you  like  to  modi 


1.  Title  of  the  job  file 

2.  Continuous  system  parameters 

3.  Discrete  system  parameters 

4.  Quantized  system  oarameters 

5.  None  of  the  above 

Please  choose  one  =>  !  3 


A  continuous  model  exists/  woulc  you  like  to: 

1.  Generate  a  discrete  model  from  the  continuous  system 
P.  Enter  a  new  discrete  system 
3.  Quit 

Please  choose  one  =>  !  1 

Enter  tau  =>!  0,25 


PM  I  NATPIX  = 

1  .  mOfT^^nOe  +  nnO  1  . 'J6T34663e-Cni 
o!inoonoooe+nan  6.c653n674e-c':i 


LAMP  DA  MATRIX  = 

5  .  326  53  ■'60e-nn2 
3.^346P326e-T01 
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iJhich  of  the  foLlowinq  would  you  like  to  'Dodify/create? 

1.  Title  of  the  job  file 

2.  Continuous  system  parameters 

3.  discrete  system  parameters 

4.  Quantized  system  oarameters 

5.  None  of  the  above 

!^lease  choose  one  =>  !  5 


1)  Initialize 

2)  Nodify  Data  File 

3)  ®rint  Files 

4)  9uild  Control  l-Ow 

5)  Simulate 

6 )  Quit 

Enter  choice  ==>  '  6 

r  15:32  2.693  132 

OTQD 

Would  you  like  to  : 

1.  Access  an  old  job  file 

2.  Create  a  new  job  file 

3.  Modify  an  old  job  file 

4.  Return  to  Main  Menu 


Please  choose  one  of  the  above  =>  !  1 

Enter  the  job  name  *>  !  servo^mctor 

The  title  of  this  data  file  is: 

This  is  an  EXAMPLE 
Is  this  the  correct  file?  !  y 

The  current  status  of  this  job  is: 

A  continuous  system  exists 
A  discrete  system  exists 

1)  Initialize 

2)  Modify  Data  File 

3)  Print  Files 

4)  Puild  Control  Law 

5)  Simulate 

6 )  Quit 

Enter  choice  ==>  !  2 


Which  of  the  following  would  you  like  to  mo d i f y / c r e a t e? 

1.  Title  of  the  job  file 

2.  Continuous  system  parameters 

3.  Discrete  system  parameters 

4.  Quantized  system  oarameters 

5.  None  of  the  above 

Please  choose  one  =>  !  4 


Would  you  like  to  generate  a  Quantized  system 
from  the  discrete  system?  =>  1  y 
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Enter  the  number  of  ouantizaticn  steos 
for  state  number  1  =>  !  8 

for  state  num'^er  2  =>  !  4 

Enter  the  uoper  and  Lower  voltaae  bounds  (u/  1) 

for  state  number  1  =>  !  4/-4 

for  state  number  2  =>  !  4/-4 

Enter  the  number  of  auantizaticn  steos 
for  input  number  1  =>  !  4 

Enter  the  upoer  and  lower  voltage  bounds  (u/  1) 

for  input  number  1  =>  !  1C/“in 


Would  you  like  the  next  state  file  built!  y 


Building  next  state  file 

Would  you  like  the  next  state  file  printed?  =>  !  ^ 


Which  of  the  following  would  you  like  to  mod i f y / c r ea t e? 

1.  Title  of  the  job  file 
?.  Continuous  system  oarameters 

3.  Discrete  system  parameters 

4.  luantized  system  parameters 

5.  None  of  the  above 

oLease  choose  one  =>  !  5 


1)  Initialize 

2)  'lodify  Data  File 

3)  orint  Files 

4)  Build  Control  Law 

5)  Simulate 

6 )  Quit 

Enter  choice  ==>  !  3 


Which  of  the  following  would  you  like  printed? 

1.  Status  of  the  job 

2.  Data  file  for  the  job 

3.  Quantized  data  file  -  next  state  file 

4.  Quantization  level  check 

5.  None  of  the  above 

Enter  choice  =>  !  4 

Uouli  you  like  to  check  the  ouantizatio!'’  level  ?  !  y 

Number  of  controllable  cells  =  32 

TotalnumberofcelLs  =  32 

Number  of  cells  moved  in  each  direction 
Dir  G  1 

1  24  7 

2  15  16 

umber  of  cells  moved  total 
n  u  m  0  1 

8  23 
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I  n  0  u  t 

I n DU  t 
Status 

Nu  m 

I  n  D  u  t 
Steps 

Total  Cells 

M  0  V  e  c 

Abs  Avg 

Cells  Moved 
i  n 

Dir  Abs 

Avg 

1 

max  unsat 

2 

2  1  .  CO 

1  0 

2  2 

0.00 

1.00 

WouLi  you  like  the  saturated  edge  array  printed?  !  n 


Which  o'f  the  following  would  you  like  printed? 

1.  Status  of  the  job 

2.  Data  file  for  the  job 

3.  Quantized  data  file  -  next  state  file 

4.  Quantization  level  check 

5.  'Jone  of  the  above 

Enterchoice=>!5 

1) Initialize 

2)  Modify  Data  File 

3) PrintFiles 

4)  Build  Control  Law 

5)  Simulate 

6 )  Quit 

Enter  choice  ==>  !  2 


Which  of  the  following  would  you  like  to  modify/create? 

1.  Title  of  the  job  file 

2.  Continuous  system  parameters 

3.  Discrete  system  parameters 

4.  Quantized  system  parameters 

5.  None  of  the  above 

Please  choose  one  =>  !  4 


A  Quantized  system  curren.tly  exists 

Do  you  still  wish  to  modify  the  Quantized  system?  =>  !  y 


Would  you  like  to  generate  a  quantized  system 
from  the  discrete  system?  =>  !  y 

Enter  the  number  of  quantization  steps 
for  state  number  1  =>  !  16 

for  state  number  2  =>  !  8 


Enter  the  upper  and 
for  state  number 
for  state  number 

lower  voltaae  bounds 

1  =>  !  4;-4 

2  =>  !  4,-4 

( u  , 

1) 

Enter  the  number  of 
for  input  number 

Quantization  steps 

1  =>  !  3 

Enter  the  upoer  and 
for  input  number 

lower  vol 
1  =>  ! 

tace  bounds 
10,-10 

(  u  , 

1 ) 

Would  you  like  the 

next  state 
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5.  None  of  the  above 
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1)  Initialize 
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3)  Print  Files 

4)  guild  Control  Law 

5 )  Simulate 

6)  Quit 

Enter  choice  ==>  •  3 


Which  of  the  following  would  you  like  printed? 

1.  Statusof  the  job 

2.  Data  file  for  the  job 
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3.  Quantized  data  file  -  next  state  file 

4.  Quantization  level  check 

5.  'lone  of  the  above 


Enter  choice  =>  !  4 

Would  you  like  to  check  the  Quantization  level  ?  !  y 

Nu-nber  of  controllable  cells  =  128 
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Enter  the  center  cell  tolerance  =>  !  2 
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Enter  number  of  steps  per  time  constant  =>  !  5 
Enter  the  number  of  recursion  levels  =>  !  3 
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Simulating  system 
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Would  you  like  to  plot  the  simulated  data?  *>  J  n 


1)  Initialize 

2)  Modify  Data  File 

3)  Print  Files 

4)  3uild  Control  Law 

5)  Simulate 

6 )  Quit 

Enter  choice  ==>  !  6 


Would  you  like  to  save  the  quantized  state  file?  =>  !  n 
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5.3-  Modelling  the  Elevation  Stabilization  System 


5.3.1.  Introduction. 

The  following  sections  describe  the  process  of  modelling  the  elevation 
stabilization  system  of  the  M-60  tank  and  determining  the  parameters  needed 
to  implement  the  controller  design  program,  "DTQD." 

The  first  step  in  the  process  involved  modelling  the  gun  and  hydraulic 
servo  system  to  obtain  the  open  loop  transfer  function.  The  models  were 
simplified  to  develop  three  representations  of  the  system:  two  first  order 
approximations,  one  with  the  trunnion  damping  modelled  as  viscous  friction 
and  the  other  with  it  modelled  as  coulomb  friction,  and  a  third  order 
approximation. 

In  modelling  the  system,  several  assumptions  were  made.  First,  the  gun  was 
considered  to  have  only  a  single  degree  of  freedom,  and  the  gunner  was  not 
included  as  part  of  this  model.  It  was  later  assumed  that  because  the 
distance  between  the  trunnion  and  the  mass  center  of  the  gun  was  relatively 
small  compared  to  the  length  of  the  gun,  for  small  angular  velocities  the 
velocity  and  acceleration  of  the  mass  center  and  trunnion  could  be 
considered  equal.  In  linearizing  the  gun  model,  a  first  order  Taylor 
series  approximation  was  done.  The  nominal  values  for  the  angular  velocity 
of  the  gun  and  hull  acceleration  was  considered  to  be  zero.  Finally,  the 
model  of  the  fluid  flow  relationship  in  the  hydraulic  system  was  taken 
directly  from  manufacturer  specifications. 

Using  the  program  "DTQD,"  the  control  law  was  developed  for  the  first  order 
system  in  which  the  trunnion  damping  was  modelled  as  viscous  friction.  The 
three  models  of  the  system  were  then  simulated  using  this  control  law. 

5.3.2.  Modelling  the  gun, 

5. 3. 2.1.  Gun  Kinematics.  From  the  dimensions  of  the  gun,  the  kinematics 
could  be  analyzed.  (See  Figure  5-8)  The  relationship  between  all  the 
necessary  "angles"  and  "sides"  were  determined  using  some  simple 
trigonemetric  identities. 

The  angle  0  can  be  expressed  in  terms  of  the  length  of  the  actuator  i  using 
the  law  of  cosines. 

c  =  sqrt  [  (4.5)^  +  (14.1)==  ]  =  14.8  (5-22) 

=  (38.28)^  +  (14.8)^  -  2(38.28)(1  4.8)cos0  (5-23) 

-  (38.28)^  -  (14.8)" 

Thus,  COS0  =  2(38.28)(14.8)  (5-24) 

The  angle  tj;  can  be  found  in  terms  of  0  and  I  using  the  law  of  sines: 

Sin  ij;  =  (sin0)(l  4.8/il)  (5-25) 
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Finally,  the  angle  $  can  be  determined  in  terms  of  G  as  follows: 

a  =  arctan  [  4.5/14.1  ]  =  0.309  rad  =  17.7°  (5-26) 

$  =  1  80  -  0  -  a  -  90  =  (1.26  -  0)  rad  =  (72.3°  -  0°)  (5-27) 

5. 3-2. 2.  Gun  Dynamics.  The  gun  is  treated  as  a  rigid  beam  supported  at  the 
trunnion,  and  considered  to  have  a  single  degree  of  freedom.  To  formulate 
the  dynamic  equations  of  the  gun,  define  three  coordinate  systems:  "H",  the 
coordinate  system  fixed  in  the  hull  of  the  tank;  "B",  the  body  fixed 
system  with  the  coordinates  being  the  principal  axis  of  the  gun;  and  "I” 
the  inertial  reference  frame.  (See  Figure  5-9)  The  angular  coordinates 
are  $  for  the  gun,  and  3  for  the  hull.  Thus,  the  angular  velocities  may 
be  expressed  as: 

3“  =  angular  velocity  of  the  gun  wrt.  the  hull  =  $  j 

T->  LT  *  -4 

oi”  =  angular  velocity  of  the  hull  wrt.  the  inertial  ref.  frame  =  6  j 

Assuming  that  the  forces  on  the  gun  due  to  the  hull  are  Fj^  and  F2>  that 
the  force  due  to  the  linear  actuator  is  f,  the  equation  for  linear  motion 
can  be  written  as  follows: 

^x  i  Fz  ^  ^  -  mg  ij  =  m  (5-28) 

where , 

m  =  mass  of  the  gun, 
g  =  acceleration  due  to  gravity, 

=  acceleration  of  the  gun  with  respect  to  the  inertial  reference 
frame,  and 

the  coordinate  i,  of  the  "I"  reference  frame  and  the  coordinate 
Cj  can  be  written  in  terms  of  the  "B"  reference  frame  by. 


e 

1  =  -  cos  ij; 

i  -  sin\\)  k. 

(5-29) 

2  =  COS  (0  + 

(5-30) 

1 

a)  i  -  sin  (0  +  a 

)  k. 

Thus, 

equation  (5-28 

)  can  be  separated 

into  two  equations, 

^x 

f  cosv  + 

mg  cos  (0  +  a) 

m  a^ 

(5-31 ) 

^z 

f  sim|; 

mg  sin  (0  +  a) 

m  a2 

(5-32) 

Because  the  distance  between  the  trunnion  and  center  of  gravity  of  the  gun 
is  small  compared  to  the  length  of  the  gun,  it  is  assumed  that  the  velocity 
and  acceleration  of  the  mass  center  is  equal  to  that  of  the  trunnion.  This 
is  of  course  justified  for  small  angular  velocities.  With  this  assumption, 
the  expression  for  the  acceleration  can  be  simplified,  since  the  terms 
representing  the  Coriolos  acceleration  and  the  relative  acceleration  of  the 
gun  with  respect  to  the  hull  can  be  neglected.  Thus,  the  accelerations, 
^2  ^rid  ajr,  are  the  accelerations  of  the  hull  in  the  z  and  x  directions. 
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respectively.  However,  this  distance  between  the  mass  center  and  trunnion 
will  remain  in  the  equations  which  calculate  moments.  Therefore,  any 
forces  applied  to  the  gun  by  the  trunnion  will  be  included  in  the  dynamics 
and  result  in  a  net  torque  about  the  y  axis. 

From  Euler's  equations,  the  equation  of  motion  due  to  rotation  can  be 
determined. 

^yy  ($  +  B)  +  dxx  -  "  ^y  (5-33) 

where , 

^2  =  the  angular  velocity  of  the  hull  about  the  x  and  z  axis, 
respectively, 

^xx>  ^yy»  ^zz  ^  principal  moments  of  inertia. 

My  =  the  moment  of  the  total  external  forces  about  the  y  axis. 

The  moment  can  be  expressed  in  terms  of  the  forces  as  follows: 

My  =  -0.12  F2  +  (38.4)  f  sin  (jj  -  fric  ($)  (5-34) 

where  fric  is  a  function  of  $  and  represents  the  damping  in  the  trunnion. 
This  function  can  be  expressed  as  when  modelled  as  viscous  friction 
(See  section  5. 3. 3.1.)  with  the  coefficient  Y  having  a  value  of  42,000  in- 
Ib/rad/sec . 

Substituting  equation  (5-34)  into  (5-33)  and  modelling  the  damping  in  the 
trunnion  as  viscous  friction,  the  equation  of  motion  for  the  system  can  be 
rewritten  as: 


lyy  ($  +  *b')  =  -0.12  m  +  g  sin  (0  +  a)  3  +  (38.28)  f  sin 

^^xx  ~  Izz^'*^x“z  ~  (5-35) 

Substituting  equation  (5-25)  into  (5-35)  and  solving  for  the  angular 
acceleration  of  the  gun  with  respect  to  the  hull,  $,  we  get: 


-0.12m  a.. 


yy 


+  566.54  sin  Q  f 

hy  ^ 


0.12  m  g  sin  ( 0  +  g) 

^yy 


X_£  — xx__5zzJliix3iiz_ 

lyy  lyy  (5-36) 


5. 3.2, 3-  Linearizing  the  gun  model.  The  equations  for  the  gun  can  be 
simplified  by  using  the  first  two  terms  of  the  Taylor  Series  to  linearize 
the  model.  $  is  a  function  of  six  variables:  a^.,  f,  $,  $,  and  102- 
After  taking  a  first  order  approximation  of  the  Taylor  series  about  the 
points  0,  f|3,  $0,  0,  0,  and  0,  respectively,  and  substituting  equations  (5- 
23)  and  (5-27)  into  equation  (5-36)  we  can  write  $  and  I  as  linear 
differential  equations. 


$ 

i 


F$  +  G 


A$  +  BP  +  Ca„ 

«  Zi 

D$ 
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(5-37) 

(5-38) 


where , 

P  =  the  pressure  which  causes  a  force  in  the  actuator  (P  =  f/Ap) 
where  Ap  is  the  area  of  the  piston. 

A  =  0.12  m  g  sin  (  $o)  -  _ 566.54  fp  cos  (1.26  -  $q) _ 

lyy  lyy  {SQrt  [1684.4  -  1131.1  C0S(1.26  -  Og)]} 


(566.54)^  fp  sin^  (1.26  -  $„) 


lyy  (sqrt  [1684.4  -  II31.I  cos(1.26  -  4>o)3} 

B  = 

566 

.54  Ar,  sin  (1  .26  -  <!>„) 

^yy 

{sqrt  [1684.4^-  1133.1  cos (1.26  -  4>o)]) 

C  = 

-0.12 

m 

I 

D  = 

yy 

-566.54 

sin  (1.26  -  4>g  ) 

(sqrt 

[1684.4 

-  1133.1  cos  (1.26  -  4>o)]} 

F  = 

-  y 

I 

yy 

G  = 

-0.12 

m  g  cos 

(  $0  )  -  0.12  m  g  sin  (  'to  )  'to 

^yy 

^yy 

+ 

566.54  f„  cos  (1.26  -  to)  'to 

^yy 

{sqrt  [1684.4  -  II3I.I  cos(1.26  -  to)]} 

- 

(566.54)^  f„  sin^  (1.26  -  t„)  to 

lyy  {sqrt  [1684.4  -  1 1 31 . 1  cos(1.26  -  $0)]^ 


5. 3. 2. 4.  Obtaining  steady-state  values.  The  values  for  the  coefficients 
in  expressions  (5-37)  and  (5-38)  were  obtained  by  using  a  small  program 
"eval"  which  was  written  to  compute  the  average  of  steady  -  state  values 
for  a  chosen  range  of  <{>.  The  program  asks  the  user  to  enter  the  value  (or 
range)  of  <t.  It  then  determined  the  actuator  length,  Z,  using  equation  (5- 
23).  The  steady  -  state  force,  f,  needed  to  obtain  a  gun  displacement  of  $ 
was  then  computed  using  equation  (5-36)  with  the  assumption  that  $,  a^,  uo^, 
and  ‘a  have  a  value  of  zero  at  steady  -  state.  Since  the  actuator 
force,  f,  is  just  the  pressure  times  the  area  of  the  piston  (f  =  PAp). 
"eval"  actually  determines  the  steady  -  state  pressure  necessary  to  obtain 
an  angle  $.  "eval"  then  calculates  the  coefficients  by  setting  the  steady 
-  state  values  for  the  force  equal  to  f,,,  and  the  user  -  selected  value  of 
41  equal  to  $0  in  equation  (5-37)  and  (5-38).  The  coefficients  were 
averaged  for  a  range  of  <{>(,  between  -10  and  45  degrees  and  found  to  be: 


A 

B 

C 

D 

F 

G 


-4.040 

X  10“* 

1  /s  ^ 

1  .405 

X  10‘^ 

l/(psi  s^) 

-4.847 

X  10“^ 

1  /in 

13.631 

in 

0.917 

rad/ sec 

-1 .641 

X  10-^ 

1  /s  ^ 
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Thus,  the  equations  become: 


$  =  (-4.04  X  10“®)  $  +  0.00145  P  +  (-4.88  x  10"^)  -  0.917  $  -  0.0164 

i  =  (13.631)  0  (5-39,  5-40) 


5. 3. 2. 5.  Transfer  function  of  the  gun.  The  transfer  function  for  the  gun 
can  be  determined  by  representing  equations  (5-37)  and  (5-38)  in  the 
frequency  domain,  where  "s"  is  the  LaPlace  operator. 

<i>(s)  =  _ ^s_P(s)  +  C  3  a^(s)  +  G  s 

+  Fs  -  A  s^  +  Fs  -  A  s^  +  Fs  -  A  (5-41) 

Using  the  values  for  the  coefficients  as  described  in  the  previous  section 
(e.g.,  in  equations  (5-39)  and  (5“40)),  the  value  of  A  is  very  small  and, 
more  importantly,  is  much  less  than  the  value  of  F.  For  this  reason,  the 
coefficient  A  has  little  effect  on  the  poles  of  the  gun  and  so  will  be 
neglected  in  the  following  analysis.  With  the  value  of  A  assumed 
negligable,  it  can  be  easily  seen  that  the  poles  due  to  the  gun  are  at  s  = 
0  and  -0.917  rad/sec.  However,  the  pole  and  zero  at  the  origin  cancel, 
leaving  a  single  pole  at  -0.917. 

5.3.3.  Modelling  the  Trunnion  Damping. 

5. 3. 3.1.  Viscous  friction.  If  we  assume  the  gun  is  level  (e.g.,  $  =  0  ), 
then  the  actuator  length,  S,,  and  the  angle  between  the  actuator  and  the 
gun,  :|j,  can  be  calculated  using  equations  (5-23)  and  (5-24)  from  section 

5.3.2.I  . 


i  =  sqrt  {  (14.1)2  +  (38,28  -  4.5)^  }  =  36.6  in. 

Since  (0  +  a)  =  90°,  and  a  was  calculated  to  be  17.7°  in  equation  (5-26),  0 
must  have  a  value  of  72.3“.  Now,  from  equation  (5-25)  we  can  determine  the 
value  of  ip 

=  arcsin  [  14.8  sin0  ]  =  22.6  ° 

I 

The  next  step  involves  determining  what  force  or  torque  is  needed  to  move 
the  gun  from  its  horizontal  position.  The  pressure  necessary  to  move  the 
gun  is  about  60  psi.  Using  this  nominal  pressure,  the  force  can  then  be 
calculated. 

f  =  PA  =  (4.72)(60)  =  283.2  lb. 

Using  the  notation  of  section  5.3.2.,  the  force  can  be  represented  with 
respect  to  the  "B"  coordinate  system  as  follows: 

f  Si  =  f  (-cos  ip  i*  -  sin  ip  k)  =  -261 .4  i  -  108.7  k 
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The  necessary  torque  to  move  the  gun  can  now  be  computed  using  the  distance 
between  the  point  of  application  of  the  force  and  the  trunnion,  and  the 
cross  product. 

Torque  =  r  x  f  =  38.4  i  x  (-261.4  i  -  108.7  k)  =  4200  in-lb  j 

We  can  now  use  this  value  to  represent  the  damping  in  the  trunnion  as 
viscous  friction.  A  simple  way  of  doing  this  is  to  assume  that  the 
friction  has  a  coefficient  of  4,200  when  the  angular  velocity  of  the  gun  is 
at  half  of  its  maximum  value,  and  a  value  of  -4,200  when  the  velocity  half 
of  its  minimum  value.  The  rate  sensor  which  measures  the  gun  elevation  rate 
saturates  for  inputs  greater  than  0.175  rad/sec.  So  if  we  assume  that  the 
angular  velocity  of  the  gun,  $,  has  a  magnitude  less  than  0.2  rad/sec,  we 
can  model  the  damping  as  viscous  friction,  42,000$.  (See  Figure  5-10) 

5. 3. 3. 2.  Coulomb  friction.  On  the  other  hand,  it  is  also  possible  to 
represent  the  damping  as  coulomb  friction.  To  model  nonlinear  friction,  we 
can  assume  a  steep  slope  for  angular  velocities  near  zero  and  a  constant 
magnitude  opposing  the  relative  gun  motion  for  all  other  velocities.  Using 
1/20  of  the  maximum  velocity  (0.01)  as  the  bounds  on  the  linear  portion, 
the  steep  slope  is  calculated  to  have  a  value  of  42,000  in-lb/rad/ sec  for 
angular  velocities  of  magnitude  less  than  1/100  rad/sec.  For  larger 
magnitudes,  the  friction  may  be  modelled  as  a  constant  of  ±  4,200  in-lb,  of 
magnitude  opposing  the  relative  motion  of  the  gun.  (See  Figure  5-11) 

5.3.4.  Hydraulics  of  the  Gun. 


5. 3. 4.1.  Elevation  load  pressure  -  fluid  flow  relationship.  The  hydraulic 
system  for  the  gun  is  modelled  and  a  block  diagram  is  shown  in  Figure  5-12. 
The  variable  Q  represents  the  flow  out  of  the  pressure  control  servo  valve, 
5,  is  the  piston  rod  velocity,  and  P  represents  the  load  pressure.  The 
other  variables  involved  are  defined  in  Appendix  A.  From  the  ^diagram,  it  is 
possible  to  find  the  equation  which  determines  P  from  Q  and  L 

P ( s )  =  (Q(s)  -  A  j,)  2  B 

Vs  +  2  6  (5-42) 

5. 3. 4. 2.  Pressure  control  servo  valve.  A  block  diagram  of  the  elevation 
servo  valve  is  in  Figure  5-13.  The  model  is  identical  to  that  found  in  the 
catalog  supplied  by  the  manufacturer,  MOOG,  for  the  Series  15  Pressure 
Control  Servovalve.  Using  the  nominal  parameters  given  by  the  manufacturer, 
the  relationship  between  the  output  flow  of  the  valve,  Q,  and  the  two 
"inputs"  (the  input  current  to  the  valve,  I  and  the  load  pressure  P  which 
is  fed  back  from  the  gun  itself)  can  be  expressed  as: 


Q(s) 


^^01  Kn?  Ktm  A-|  )  I(s) 
A]  ^  s  ~ 


(Kqi  Afj  +  KpQ^  Kp)  Kq2  A2  P(s) 

%  Afj  Kp) 

(5-43) 


5. 3. 4. 3.  Combining  pressure  -  fluid  flow  relationship  with  servo  valve. 
Block  diagrams  5-12  and  5-13  can  be  combined  to  determine  the  total 
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Figure  5-1 


Figure  5-11.  Modelling  Coulomb  friction 

59 


Oil  Compliance 


Flow  from 
Servo  Valve 


0 


Differentia 

Pressure 


Kt 

/ 

!  L 

1 

Leakage  coefficient 


“  Z 


Cylinder  area 


(from  gun) 


Figure  5-12.  Hydraulic  System 


Figure  5-1 3-  Elevation  Servo  Valve 


0 


6 


transfer  function  for  the  hydraulics  of  the  system.  Therefore, 
substituting  equation  (5-43)  into  (5-42),  and  solving  for  the  pressure,  the 
relationship  between  load  pressure  and  input  current  and  actuator  velocity 
can  be  determined. 


P(s)  2  g  (Kqt  Kqp  Ktm  Ai )  I(s)  -  2  e  Aq  (Kp  ^  s  +  KK  Kg)  I 

A  ■]  ^  S  +  Kg  KK )  V  S  +  2  B  Kq2  ^2  ^  ^  Kj^  ( Kp  i\7[ 

(5-44) 

where  KK  =  (Kq-|  Af^  +  KpQ-|  Kp). 


Substituting  in  the  values  as  listed  in  Appendix  A,  the  transfer  function 
for  the  hydraulics  of  the  system  can  be  written  as: 


P 


where , 
I 
i 


39,573,1  70.73  I  -  (  36,307.69  s  +  6,294,281.76  )  I 

?  181 .05  s  +  1 39,777.47 


(5-45) 


the  input  current  (mA)  , 

the  actuator  velocity  (in/ sec). 


Thus,  the  poles  of  the  servo  valve  are  located  at  s  =  -90.53  ±  362.74  i. 


5.3.5.  Open  Loop  System. 

From  the  above  sections  a  block  diagram  of  the  open  loop  linearized  system 
can  be  constructed.  (See  Figure  5-14).  The  voltage  representing  the 
velocity  of  the  gun  can  be  expressed  as: 

Wy  =  Kt  (w  -  6)  (5-46) 

where , 

K-p  =  the  gain  of  the  rate  sensor  =  150  vol  ts/rad/sec 
6  =  the  velocity  of  the  hull  as  defined  in  section  5. 3. 2. 2. 

$  =  a)(s)  =  150  (B  z  I(s)  +  (C  a^(s)  +  G)(s^  +  K,  s  +  K,) 

(s  +  F)(s^  +  Kj  s  +  K2)  +  B  D  (xs  +  y) 

(5-47) 

where , 

s  =  the  LaPlace  operator, 

B,  C,  D,  F,  and  G  are  the  averaged  parameters  of  the  gun  as  defined  in 
section  5. 3. 2. 4: 

B  =  1.405  X  10“^  1/(psi  s^) 

C  =  -4.847  X  10“®  1/in 
D  =  13.631  in 
F  =  0.917  rad/sec 
G  =  -1 . 641  X  1 0~^  1  /s^ 
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39,573,170.73  I  -  (36,307.69s  +  6,294.281.76  ). 


X,  y,  z,  Kj,  K2  are  the  elevation  servo  valve  parameters  as  found  in 
section  5.3-^*3- 

X  =  36,307.69  psi/in 

y  =  6,294,281.76  psi/in  sec 
z  =  39,573,170.73  psi/s^  mA 
Ki  =  181  .05  1 /sec 

Ka  =  139,777.47  l/sec^ 

The  program  "eval"  (See  section  5.3.2. 4.)  not  only  computes  the  average 
parameters  for  the  gun,  but  also  determines  the  open  loop  poles  for  the 
system.  The  poles  were  found  to  be  at  -90.1  +  363.61  and  -1,78.  Also, 
"eval"  was  used  to  compute  the  dc  gain  of  the  system,  which  was  0.22217. 

5.3.6.  Simplified  Models. 

5.3.6. 1  First  order  approximation.  The  above  system  can  be  simplified  to 
a  first  order  system  by  "ignoring"  the  complex  poles  (-90.1  ±  363.61  i). 
Keeping  the  dc  gain  constant,  the  first  order  system  can  be  represented  by: 

m  (s)  =  0.395  I(s) 

s  +  1,78  (5-48) 

This  model  has  a  pole  at  -I.78  as  desired  and  a  dc  gain  equal  to  that  of 
the  orglnal  third  order  system.  The  input  to  the  system  is  the  current 
into  the  valve.  The  constant  input  denoted  by  G  in  the  above  sections  has  a 
value  of  only  1.714  x  10"^  and  so  it  shall  be  neglected.  Also,  the 
coefficient  of  the  input  a^  is  only  5.410  x  10“^.  Unless  the  acceleration 
is  very  large,  which  is  impractical,  this  factor  will  also  be  small 
compared  to  the  input  due  to  the  current.  For  instance,  even  if  the  tank 
is  accerating  at  1  g  (32.2  ft/sec)  and  we  assume  that  this  acceleration  is 
completely  in  the  "z"  direction  (this  is  not  necessarily  the  vertical 
direction  since  "z"  is  a  body  fixed  axis  in  the  gun  itself),  the  term  due 
to  the  input  would  only  have  a  value  of  about  2.1  sec~‘.  Thus,  this 
input  is  also  neglected. 

This  is  the  system  that  was  used  to  develop  a  control  law  using  the  program 
"DTQD"  (See  section  5.2.)  It  may  be  expressed  in  state-space  notation  as: 

=  -1.78  $  +  0.395  I  (5-49) 

5. 3.6, 2.  First  order  system  with  Coulomb  friction.  In  the  previous  models 
the  damping  in  the  trunnion  has  been  treated  as  viscous  friction.  In 
particular,  the  modelled  friction  has  had  a  coefficient  of  (42jOOO/Iyy)  in¬ 
lb/rad/sec.  Friction  is  the  primary  parameter  which  causes  the  dominant 
pol  e  to  1  ie  at  -1 .78. 

A  second  representation  of  the  first  order  system  can  be  made  by  modelling 
the  damping  in  the  trunnion  as  nonlinear  friction.  In  section  5. 3. 3. 2., 
friction  was  modelled  as  nonlinear  coulomb  friction  with  a  magnitude  of 
4,200/Iyy  in-lb  for  gun  velocities  greater  than  0.01  rad/sec.  For 
magnitudes  less  than  0.01  rad/sec,  friction  was  essentially  modelled  as 
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viscous  friction  with  a  very  large  coefficient.  In  fact,  using  this  model 
for  friction,  the  entire  system  can  be  described  by: 

|o.395  I  -  0.0917;  for  $  >  0.01 

$  =  <  0.395  I  +  0.0917;  for  o  <  -0.01  (5-50) 

[^-9.17  I  +  0.395  I;  for  -0.01  <  $  <  0.01 

5.3.6.3.  Third  order  system.  Another  model  of  the  system  used  to  "check" 
the  control  law  was  the  model  of  the  complete  third  order  system.  This 
model  i^s  very  similar  to  that  of  equation  (5“^6)  except  the  velocity  of  the 
hull,  6,  is  omitted  and  only  a  single  input,  the  current  into  the  valve,  is 
modelled.  Systems  implementing  B  are  considered  in  section  5. 3. 6. 4.  The 
other  inputs,  denoted  by  G  and  az  above,  are  ommitted  for  the  reasons 
explained  in  5.3-6.1.  The  model  can  be  represented  by; 

_ 55493.2  I(s) 

oj(s)  =  [s  +  (90.1  ±  363.6i)]Cs  +  1.73]  (5-51) 

Using  u),  (jj,  and  oj  as  states,  the  state  -  space  representation  of  the  system 
is  : 


0 

1 

0 

0 

0 

0 

1 

W  + 

0 

-249778.14 

-140645.60 

-181 .98 

55493.2 

(5-52) 

5. 3.6. 4.  Models  with  a  "Disturbance".  In  all  the  simplified  models 
derived  thus  far,  the  term  6,  the  angular  velocity  of  the  hull  of  the  tank 
in  the  "y"  direction,  has  been  neglected.  This  term  may  be  added  to  any  of 
the  above  three  models  to  create  three  more  representations  of  the  system. 
6  is  simply  treated  as  an  uncontrolled  input  (i.e.,  a  disturbance)  into  the 
system,  as  seen  in  Figure  5-14.  In  our  case,  we  set  6  equal  to  a 
sinusoidal  waveform  whose  amplitude  and  frequency  could  be  arbitrarily 
chosen. 

5.3.7.  Using  "DTQD". 

To  obtain  a  control  law  for  the  original  simplified  model  -  the  first  order 
system  with  linear  friction  and  no  "disturbances,"  the  program  "DTQD"  was 
implemented.  To  use  "DTQD,"  we  first  had  to  determine  various  parameters 
of  the  system  including  the  sampling  time,  t,  and  the  number  of 
quantization  steps. 

Keeping  in  mind  that  our  actual  system  did  have  a  "disturbance"  which 
caused  the  occurance  of  6,  the  angular  velocity  of  the  hull,  we  determined 
the  appropriate  value  for  x.  It  was  assumed  that  the  highest  frequency  for 
the  hull  velocity  is  approximately  15  Hz.  The  sampling  rate  was  chosen  such 
that  it  would  be  possible  to  sample  about  six  times  per  cycle.  Therefore, 
T  =  0.01  was  picked. 
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Thus,  the  discrete-time  representation  of  this  system  is: 

x(K+1)  =  0.982  x(K)  +  0.00392  I(K)  (5-53) 

To  determine  the  number  of  quantization  steps,  we  first  had  to  know  the 
upper  and  lower  limits  for  our  state  and  input.  Because  the  rate  sensor 
which  measures  the  gun  elevation  rate  saturates  for  inputs  greater  than 
0.175  rad/sec,  we  chose  ±  0.2  rad/sec  as  our  upper  and  lower  bound  for  the 
state.  The  input  bounds  were  given  by  the  servo  valve  manufacturer  to  be  ± 
1  0  mA. 

In  choosing  the  number  of  quantization  steps,  the  following  "rule"  was 
implemented:  Use  twice  the  number  of  steps  which  takes  the  state  from  its 

maximum  value  down  to  10^  of  its  upper  bound. 

(-1 .78) (0.01  )x 

0.2  e  =0.02  ==>  X  =  129 

Thus,  the  desired  number  of  quantization  steps  was  chosen  to  be  256. 

In  quantizing  the  input,  it  was  desired  that  a  change  of  one  step  in  the 
input  would  approximately  cause  a  change  in  one  step  of  the  state.  Thus, 
the  following  ratio  was  desired: 

0.2  =  10  (0.00392) 

2^  X 

where  0.2  and  10  represent  the  upper  bounds  of  the  state  and  input, 
respectively;  256  and  x  represent  the  number  of  quatization  steps  for  the 
state  and  input,  respectively;  and  0.00392  is  the  input  "matrix"  for  the 
corresponding  discrete-time  model.  Solving  the  ratio  for  x  we  find  that  the 
number  of  input  steps  is  approximately  32. 
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5.4.0.  Simulation  Results 


5.4.1.  The  Model. 

The  previous  section  developed  a  mathematical  model  for  the  elevation  actuator 
of  the  M60  tank.  After  the  system  was  linearized,  the  actuator  was  a  third  order 
system  with  a  pole  at  -1.78,  and  two  complex  poles  at  -90±360j.  If  the  two 
complex  poles  are  ignored,  the  resulting  model  of  the  elevation  dynamics  becomes 
a  simple  first  order  system  with  a  pole  at  -1.78.  This  simple  first  order  system 
was  used  to  derive  the  control  law  for  the  elevation  system.  After  the 
controller  was  developed,  it  was  simulated  using  more  accurate  models  of  the 
elevation  dynamics.  The  resulting  response  should  be  a  reasonable  approximation 
of  the  actual  response  expected  if  the  controller  was  used  on  the  vehicle.  As 
might  be  expected,  there  were  significant  deviations  from  the  response  of  the 
idealized  first  order  system.  However,  with  careful  selection  of  the  controller 
parameters  some  of  these  problems  can  be  minimized.  These  relations  are 
explored  in  the  text  that  follows. 


5. 4. 2.  The  Control  Law. 

A  control  law  can  be  constructed  using  the  theory  presented  in  section  1.0  for 
the  system 

dx/dt  =  -1 , 78  x(t)  +  0. 395  u(t)  (5-54) 

The  particular  gyro  used  on  the  the  elevation  controller  saturates  at  Vout  = 
+0.2  volts.  So  these  were  used  as  the  limits  on  the  state  for  building  the 
control  law.  Likewise  the  hydraulic  servo  valve  saturates  at  lin  =  ±  10  ma. 
Thus  this  was  used  to  define  the  limits  on  the  input  to  the  system.  Considering 
the  expected  range  of  frequencies  of  the  disturbances  to  the  vehicle,  a  sample 
time  of  T  =  0.  01  sec,  or  100  Hz  was  used.  Finally,  the  state  was  divided  into  256 
levels  and  the  inputs  into  32  levels.  Although  these  parameters  could  be 
changed  the  resulting  system  response  seems  to  be  well  controlled. 

Using  the  system  (5-54)  and  the  parameters  presented  above,  a  control  law  based 
on  DTQD  system  theory  can  be  derived  using  the  program  described  in  2. 0.  For 
this  example  a  minimum  time  strategy  was  adopted.  Table  5-1  summarizes  the 
results  of  the  control  law.  The  bang-bang  characteristiic  is  quite  evident. 
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table  b“1.  Control  Law 


Quantized  State 

Discrete  State 
(volts) 

Quantized 

Input 

Discrete 

Input 

(mA) 

to  103 

198  to  039 

32 

10.00 

104 

-.038 

31 

9.38 

105 

-.036 

30 

8.75 

106 

-.034 

31 

9.38 

107 

-.033 

29 

8. 12 

108 

-.031 

29 

8. 12 

109 

-.030 

28 

7.50 

110 

-.028 

27 

6.88 

111 

-.027 

28 

7.50 

112 

-.025 

26 

6.25 

113 

-.023 

25 

5.62 

114 

-.022 

26 

6.25 

115 

-.  020 

24 

5.  00 

116 

-.019 

24 

5.  00 

117 

-.017 

23 

4.38 

118 

-.016 

22 

3.75 

119 

-.014 

23 

4.  38 

120 

-.013 

21 

3. 12 

121 

-.011 

20 

2.50 

122 

-.009 

21 

3.12 

123 

-.008 

19 

1.88 

124 

-.006 

19 

1.88 

125 

-.005 

18 

1.25 

126 

-.003 

17 

0.62 

127 

-.002 

18 

1.25 

128 

0.0 

16 

0.0 

129 

.002 

15 

-0.62 

130 

.003 

16 

0.0 

131 

.005 

14 

-1.25 

132 

.006 

14 

-1.25 

133 

.008 

13 

-1.88 

134 

.009 

12 

-2.50 

135 

.011 

13 

-1.88 

136 

.013 

11 

-3.  12 

137 

.014 

10 

-3.75 

138 

.016 

11 

-3. 12 

139 

.017 

9 

-4.38 

140 

.019 

9 

-4.38 

141 

.020 

8 

-5.00 

142 

.022 

7 

-5.62 

143 

.023 

8 

-5.00 

144 

.025 

6 

-6.25 
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145 

.027 

5 

-6.88 

146 

.028 

6 

-6.25 

147 

.030 

4 

-7.50 

148 

.031 

3 

-8. 12 

149 

.033 

3 

-8. 12 

150 

.034 

2 

-8.75 

to  256 

. 038  to 

.200 

1 

-9.38 

5, 4. 3.  Step  Response. 

The  closed-loop  system  driven  by  the  control  law  presented  in  table  5-1  was 
simulated.  This  section  reports  some  of  the  characteristics  that  were  observed 
in  the  simulations.  The  portion  is  divided  into  several  sections.  The  first 
section  looks  into  how  well  the  control  law  acts  on  the  first  order  system  it  was 
designed  to  control.  As  expected  it  performs  quite  well.  The  next  section 
examines  how  well  the  controller  works  on  the  more  realistic  third  order  model 
of  the  elevation  dynamics.  Finally,  the  changes  in  the  response  when  coulomb 
friction  replaces  the  linear  viscous  friction  term  are  examined. 


5.4. 3.1.  First  Order  Model. 

Figure  5-15  shows  the  response  of  the  system  being  regulated  by  the  DTQD 
controller.  The  system  is  perturbed  by  an  initial  condition  of  0. 17  rad/sec  and 
the  resulting  response  is  plotted.  In  the  early  part  of  the  response,  a  clear 
minimum  time  trajectory  is  shown.  (The  system  is  being  driven  to  zero  velocity 
at  its  maximum  acceleration. )  After  the  initial  phase  of  the  response,  a  limit 
cycle  is  evident  in  the  output  of  the  system.  This  is  an  expected  result 
considering  the  size  of  the  quantization  levels  that  were  used. 

Recall  from  the  theoretical  development  of  DTQD  system  theory,  that  the  grid 
embedding  process  allowed  large  quantization  levels  without  sacrificing 
accuracy.  Figure  5-16  shows  how  the  embedding  process  improved  the  response  of 
this  first  order  system.  In  this  example  embedding  takes  place  whenever  the 
state  is  within  ±0.  02  rad/sec  from  the  origin  (the  inner  105t  of  the  state  space). 
When  this  occurs  the  state  and  input  are  scaled  by  a  factor  of  ten.  The  effect  of 
the  embedding  process  on  the  response  of  the  system  is  clear  from  the  figure.  As 
the  system  approaches  the  origin  from  0. 17  the  response  is  indentical  to  that  of 
a  system  without  embedding  (Fig.  5-15)  until  the  state  reaches  0. 02.  At  this 
point  the  embedding  takes  place  and  the  system  is  slowed.  However,  since  the 
quantization  levels  are  cut  by  ten,  the  system  is  under  the  influence  of  a  much 
more  accurate  control  law,  and  therefore,  the  limit  cycle  behavior  is 
eliminated.  As  might  be  expected,  adding  more  embedding  cycles  does  not  improve 
the  system  response,  see  Fig  5-17.  Therefore,  it  can  be  concluded  that 
configuring  this  system  with  an  embedding  process  with  one  or  two  embedding 
levels  is  the  best  solution  for  the  controller  in  this  situation. 
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Time  (sec) 


Figure  5-17.  First  Order  System  with  Two  Embedding  Processes 
5. 4. 3. 2.  Third  Order  System. 

The  response  of  the  third  order  model  of  the  gun  elevation  dynamics  for  the 
control  law  developed  in  section  5.4.2  is  presented  in  Fig.  5-18  thru  Fig  5-21. 
Again  the  minimum  time  response  is  evident  in  the  graphs.  However,  the 
magnitude  of  the  limit  cycle  has  dramatically  increased.  This  is  expected  since 
the  other  two  poles  are  due  to  a  combination  of  the  lag  in  the  valve  and  the 
compressibility  of  the  hydraulic  fluid.  Once  again  the  simulations  show  that 
the  embedding  process  will  eliminate  most  of  the  undesirable  characteristics  of 
the  response.  But,  in  this  case  it  is  advisable  to  have  about  3  to  4  embeddings 
to  damp  out  all  of  the  limit  cycle  behavior. 
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Figure  5-20.  Third  Order  System  with  Two  Embedding  Processes 


Time  (sec) 


Figure  5-21 .  Third  Order  System  with  Three  Embedding  Processes 


5. 4. 3. 3.  Coulomb  Friction. 


Finally,  Fig.  5-22  thru  Fig.  5-24  illustrates  the  response  of  the  first  order 
system  with  the  trunnion  modelled  with  coulomb  friction  instead  of  viscous 
friction.  It  does  not  make  a  large  difference  whether  the  friction  is  modelled 
with  either  coulomb  or  viscous  characteristics.  This  is  due  to  the  extremely 
large  gain  of  the  system.  The  same  conclusions  can  be  drawn  as  for  these  cases 
as  with  the  first  order  system  with  linear  friction.  Because  of  the  large 
quantization  levels,  a  limit  cycle  will  exist  unless  embedding  is  used.  Two  or 
three  embedding  levels  should  be  adequate  to  control  the  system. 


Time  (sec) 


Figure  5-22.  First  Order  System  with  Coulomb  Friction  and  Zero  Embeddings 


73 


Time  (sec) 


Figure  5-23.  First  Order  System  with  Coulomb  Friction  and  One  Embeddings 


0.  18  T 


Time  (sec) 


Figure  5-24.  First  Order  System  with  Coulomb  Friction  and  Two  Embeddings 


5.4.4.  Disturbance  Rejection. 


The  disturbance  rejection  of  this  controller  will  be  examined  as  a  final 
exercise  to  evaluate  the  performance  of  the  DTQD  controller.  In  this  case  the 
disturbance  will  be  considered  to  be  the  velocity  of  the  hull.  Although  the 
controller  was  not  specifically  designed  to  reject  distubances,  it  is  an 
interesting  excercise  to  examine  its  performance  in  this  capacity. 
Unfortunately,  it  did  not  perfom  as  well  in  this  area  as  it  did  as  a  regulator. 
This  problem  will  be  examined  more  closely  in  the  follow-on  project.  Figure 
5-25  illustrates  the  model  used  to  check  the  rejection  capabilities  of  the 
controller.  As  with  the  step  response,  we  will  examine  both  the  first  and  third 
order  models. 


Hull  Velocity 


Figure  5-25.  Disturbance  Model 
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5. 4. 4.1. 


First  Order  Model. 


Figures  5-26  through  5-29  shows  a  typical  response  of  the  first  order  system 
with  a  sinusoidal  disturbance,  of  different  frequencies,  amplitudes  and 
embedding  levels.  The  amplitudes  of  the  disturbance  are  attenuated  by  the 
controller.  Figure  5-30  is  a  plot  of  the  frequency  response  of  the  system  due 
to  a  sinusoidal  disturbance  input,  without  embedding  being  used.  As  expected, 
the  lower  frequencies  (0-5  Hz)  are  attenuated  more  than  the  higher  ones  (greater 
than  5  Hz).  A  second  plot  of  the  distubance  cancelling  effects  as  a  function  of 
frequency  of  this  system  is  given  in  Fig.  5-31,  however,  in  this  system  the 
embedding  process  was  engaged.  The  rejection  of  the  sinusoidal  inputs  for  the 
system  with  or  without  embedding  are  comparable.  However,  the  actual  time 
domain  response  of  the  system  (Fig.  5-26  thru  Fig  5-31)  is  considerably  smoother 
for  the  system  with  embedding.  Therefore,  embedding  improves  the  rejection 
capabilities  of  a  system  controlled  by  a  DTQD  regulator.  Only  the  regulation 
properties  of  DTQD  controllers  have  been  fully  developed.  Therefore,  it  is  not 
surprizing  to  see  the  poor  rejection  responses  below.  However,  the  follow  on 
project  will  look  into  disturbance  rejection  extensively. 


Time  (sec) 


Figure  5-26.  First  Order  System  with  Zero  Embeddings  and  d(t)  =  0. 1  sin  (2Tit) 
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Figure  5-27.  First  Order  System  with  Three  Embeddings  and  d(t)  = 


Figure  5-28.  First  Order  System  with  Zero  Embeddings  and  d(t)  =  0 


0. 1  sin  (Zift) 


4  ..  f  <  \ 

.  I  sin  luii l; 
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Figure  5-29.  First  Order  System  with  Three  Embeddings  and  d(t)  =  0. 1  sin  (lOnt) 


Frequency  of  Disturbance  (Hz) 


Figure  5-30.  Disturbance  Frequency  Response  of  the  First  Order  System  without 
Embedding 


Frequency  of  Disturbance  (Hz) 


Figure  5-31.  Disturbance  Frequency  Plot  of  the  First  Order  System  with, 
embedding 

5. 4. 4. 2.  Third  Order  System. 

Figure  5-32  thru  Fig.  5-35  are  plots  of  the  response  of  the  third  order  model  of 
the  elevation  dynamics  to  a  sinusoidal  disturbance.  The  limit  cycle  behavior  of 
the  system  is  greatly  reduced  by  inceasing  the  number  of  embedding  levels.  As 
with  the  step  response,  about  three  embedding  levels  are  needed  to  adequately 
damp  out  the  high  frequency  oscillation.  A  plot  of  the  distubance  cancelling 
effects  as  a  function  of  frequency  of  this  system  is  given  in  Fig  5-36. 
Remember  that  at  this  point  in  time  that  only  the  regulation  properties  of  DTQD 
controllers  have  been  fully  developed.  Therefore,  it  is  not  surprizing  to  see 
the  poor  rejection  responses  below.  However,  the  follow-on  project  will  look 
into  disturbance  rejection  extensively. 


79 


0.008 
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Figure  5-32,  Third  Order  System  with  Zero  Embeddings  and  d(t)  =  0. 1  sin  (2iTt) 


Figure  5-33.  Third  Order  System  with  Three  Embeddings  and  d(t)  =  0. 1  sin  (2iit) 
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Figure  5-34.  Third  Order  System  with  Zero  Embeddings  and  d(t)  =  0. 1  sin  (lOirt) 


Time  (sec) 


Figure  5-35.  Third  Order  System  with  Three  Embeddings  and  d(t)  =  0. 1  sin  (lOnt) 
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Figure  5-36.  Disturbance  Frequency  Plot  of  Third  Order  System  without  embedding 


Compare  Fig.  5-33  with  Fig.  5-37.  The  amplitude  of  the  high  frequency 
oscillation  is  greatly  reduced  in  5-37,  although  the  same  sine  wave  is  forcing 
the  two  systems.  The  reason  for  this  is  the  embedding  process  takes  place  at 
different  times  for  the  two  systems.  In  Fig  5-33  embedding  takes  place  when  the 
system  is  within  the  center  103:  (.02  rad/sec)  of  the  state  space.  Fig  5-37,  it 
takes  place  in  the  inner  20^  (.04  rad/sec).  The  steady  state  response  of  the 
system  in  Fig  5-33  is  little  greater  than  0. 02  rad/sec.  This  means  the  system  is 
constantly  jumping  from  one  embedding  level  to  another  as  the  response  passes 
through  0.02  rad/sec.  This  explains  the  somewhat  erratic  behavior  of  the 
response  in  Fig  5-33.  With  a  larger  embedding  region  the  steady  state  response 
does  not  cross  the  the  boundary  for  embedding,  and  therefore,  the  response  for 
this  system  (Fig  5-37)  is  much  smoother. 

To  obtain  the  smoother  response  for  all  amplitudes  of  disturbances  it  is 
necessary  to  insure  that  the  response  never  crosses  a  boundary  for  embedding. 
This  is  impossible  if  embedding  is  done  at  discrete  intervals,  since  a 
disturbance  can  always  be  found  that  will  have  an  amplitude  which  will  cross  the 
boundary.  For  example,  if  the  controller  was  programmed  to  embed  whenever  the 
state  was  in  the  center  20  cells,  then  a  disturbance  can  be  found  that  would 
continuously  enter  and  leave  the  center  20  cells.  A  method  to  correct  this 
problem  is  to  use  a  continuous  embedding  system.  This  technique  would  measure 
the  distance  that  the  state  is  from  the  origin  and  then  scale  the  the  states  and 
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the  inputs  by  an  amount  proportional  to  this  distance.  Thus,  the  quantized 
states  would  always  appeared  to  the  controller  to  be  at  approximately  the  same 
position  from  the  origin.  Also,  since  embedding  takes  place  continuously,  there 
will  be  no  discrete  boundaries  will  have  been  shown  to  add  noise  to  the  response. 
Therefore,  it  is  suggested  that  this  technique  be  explored  in  a  follow-on 
project. 


Time  (sec) 


Figure  5-37  Response  of  the  System  with  Scaling  Factor  Increased  to  20% 
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APPENDIX  A 
PARAMETERS  VALUES 


A-1 
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A-2 


1.0.  GUN  PARAMETERS 


M 

=  mass  = 

18.5  lb  s^/in 

W 

=  weight 

=  7141  lb. 

^xx 

=  moment 

of  inertia  about 

X 

axis  = 

100  in-lb-s^ 

^yy 

=  moment 

of  inertia  about 

y 

axis  = 

45800  in-lb-s 

^zz 

=  moment 

of  inertia  about 

z 

axis  = 

45800  in-lb-s 

See 

also  Figure  5-8  in  section 

5. 

3.2. 

2.0.  HYDRAULIC  CYLINDER  PARAMETERS 

B  =  Oil  Gompliance  =  200,000  Ib/s^ 

V  =  Volume  of  Hydraulic  system  =  52  in^ 

Ap  =  Cylinder  area  =  4.72  in^ 

Kl  =  Leakage  factor  =  0.001 

3.0.  ELEVATION  SERVO  VALVE  PARAMETERS 

I  =  Input  current  =  ±  1 0  mA  rated 

T  =  Torque  on  armature  flapper  =  ±  0.165  in-lb  rated 
Qj  =  Hydraulic  amplifier  flow  to  drive  the  spool  =  ±  0.23  cis  max 
Q2  =  Servo  valve  flow,  no  load  =  +  55  cis  rated 
Xg  =  Spool  displacement  =  ±  0.020  in  rated 

Pi  =  Hydraulic  amplifier  differential  pressure  =  ±  890  psi  rated 
P  =  Load  differential  pressure  =  ±  3000  psi  rated 
“  Torque  motor  gain  =  0.0165  in-lb/ma 
Kqi  =  Hydraulic  amplifier  motor  gain  =  65  cis/radian 
Kq2  =  Spool  flow  gain,  no  load  =  8850  cis/in 
KpQi=  Hydraulic  amplifier  loading  effect  =  1.26  x  10"“  cis/psi 
Kg  =  Spool  Bernoulli  force  gradient,  no  load  =  1040 
Kp  =  Net  stiffness  of  armature/flapper  =  45  in-lb/rad 
Ai  =  Spool  driving  area  =  0.041  in^ 

A2  =  Spool  feedback  end  area  =  0.0122  in^ 

Aj^  =  Nozzle  frontal  area  =  3.14  x  10"“  in^ 

%  =  Moment  arm  to  nozzles  =  0.34  in 
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APPENDIX  B 

PROGRAM  DOCUMENTATION  FOR  "DTQD" 
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1.0.  INTRODUCTION 


The  program,  "DTQD,"  aids  the  user  in  designing  a  controller  for  a  discrete 
time  quantized  data  system.  The  user  enters  information  regarding  the 
system  and  data  converters,  and  the  program  creates  the  DTQD  model  of  the 
system.  If  the  quantization  levels  lead  to  an  acceptible  model  of  the 
system,  the  user  may  then  have  "DTQD"  develop  a  control  law  for  the  system 
using  any  desired  cost  function.  Finally,  the  program  lets  the  user 
simulate  the  controlled  system,  and  plot  any  combination  of  states,  inputs 
and  time. 

The  program  is  being  developed.  Although  each  stage  works,  modifications 
are  still  being  made  to  make  it  simpler. 

The  program  is  coded  in  PL1  .  Although  it  is  currently  being  run  on  the 
Honeywell  68-DPS-2  MULTICS  system  computer,  with  slight  modifications  it 
could  easily  be  implemented  on  most  main  frames.  The  program  consists  of 
the  main  procedure,  DTQD,  and  11  external  subprograms  which  are  called  by 
DTQD.  Each  of  these  procedures  may  call  internal  subroutines  as  well. 

2.0.  EXTERNAL  VARIABLES 

The  following  is  an  alphabetical  list  of  the  external  variables  used  in  the 
program. 

a_matrix  -  A  (n  x  n)  array  and  is  the  system  matrix,  (input  by  user) 

b_matrix  -  A  (n  x  p)  array,  the  input  matrix  for  the  system,  (input  by 
user ) 

control_law_f ile_ptr  -  A  pointer  to  the  beginning  of  the  control  law 
file,  (corresponds  to  the  based  variable  control_law) 

cost_funGtion_code  -  An  integer  code  representing  which  cost  function  is 
to  be  used,  (input  by  user) 

f lag.own_quant_f ile_exists  -  A  one  bit  variable  which  designates  whether 
or  not  a  file  containing  the  quantized  model  exists. 

input_cost_matrix  -  This  (p  x  1 )  array  is  the  diagonal  elements  of  the 
input  weighting  matrix  (i.e.  the  "R"  matrix),  which  is  assumed  to  be 
diagonal.  It  is  entered  by  the  user  if  a  quadratic  or  minimum-control - 
effort  cost  function  is  desired. 

job_name  -  A  user-inputted  variable  representing  the  name  of  the  current 
job.  It  must  be  one  word  and  contain  less  than  50  characters.  These 
characters  may  be  any  combination  of  letters,  numbers,  and  underscores; 
however,  the  first  character  must  be  a  letter. 

lambda_matrix  -  A  (n  x  p)  array,  the  discrete  -  time  input  matrix  for  the 
system.  (may  be  input  by  user  of  calculated  by  program) 
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n  -  The  number  of  states,  (input  by  user) 

next  state_f ile_ptr  -  A  pointer  to  the  beginning  of  the  quantized  data 
fileT  (corresponds  to  the  based  variable  the_next_state_mapping) 

next  state  map  -  A  (num_state_combs  x  num_input_combs )  array  which 
contains  the  code  of  the  next  state  for  each  state/input  combination. 

num  controllable_Gells  -  The  number  of  controllable  cells 

number_of  steps  i  -  A  (p  x  1)  array  containing  the  number  of  steps  of  the 
A/D  converter  for  each  input.  (input  by  user) 

number_of  steps_s  -  A  (n  x  1)  array  containing  the  number  of  steps  of  the 
A/D  converter  for  each  state,  (input  by  user) 

num_input_Gombs  -  The  number  of  input  combinations. 

num_state_Gombs  -  The  number  of  state  combinations. 

offset_i  -  A  (p  X  1)  array  used  in  computing  the  coded  version  of  the 
input . 

offset_s  -  A  (n  X  1)  array  used  in  computing  the  coded  version  of  the 
state . 

p  -  The  modified  number  of  inputs.  This  value  is  identical  to  the 
variable  "p  real"  above  except  in  the  case  where  "p_real"  is  zero  in  which 
the  value  of  "p"  becomes  1. 

p_real  -  The  number  of  inputs  (input  by  user) 

phi_matrix  -  A  (n  x  n)  array,  the  discrete  -  time  system  matrix  (may  be 
input  by  user  or  calculated  by  program) 

quantum_step_size_i  -  A  (p  x  1 )  array  containing  the  quantum  steps  size 
of  the  A/D  converter  for  each  input.  It  is  used  to  convert  the  continuous 
-  time  arrays  into  disGrete_time  arrays  and  vice-versa. 

quantum  step  size  s  -  A  (n  x  1 )  array  containing  the  quantum  step  size  of 
the  A/D  converter  for  each  state.  It  is  used  to  convert  the  continuous  - 
time  arrays  into  discrete_time  arrays  and  vice-versa. 

sat_edge  -  A  (num_state_combs  x  num_input_combs )  one  bit  array.  The 
elements  of  the  array  are  "1"  if  the  corresponding  cell  is  lead  into 
saturation  or  to  an  uncontrollable  cell  given  the  corresponding  input,  and 
"0"  otherwise. 

state_cost_matrix  -  This  (n  x  1)  array  is  the  diagonal  elements  of  the 
state  weighting  matrix  (i.e.  the  "Q"  matrix),  which  is  assumed  to  be 
diagonal.  It  is  entered  by  the  user  if  a  quadratic  cost  function  for  the 
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controller  is  desired. 


status  flags  -  The  following  one  bit  variables  which  are  used  to  record 
which  part  of  the  program  has  been  completed  for  the  current  job  - 
f 1 ag.cont_exi sts ,  f 1 ag.di scr et e_ex i s ts  ,  f 1 ag.quanti zed_exi sts , 
f lag.control_law_val id,  and  f lag.sim_val id. 

tau  -  The  sampling  period.  This  value  is  used  to  calculate  the  discrete 
-  time  model  of  the  system.  (input  by  user) 

title  -  A  user  -  inputted  variable  containing  the  title  for  the  specific 
job.  It  may  contain  any  keyboard  characters  and  have  a  maximum  length  of 
70  characters;  however,  if  blanks  are  used,  the  entire  variable  must  be 
enclosed  in  quotation  marks  ("). 

uncontrol lable_cell  -  A  one  bit  array  of  dimension  (num_state_combs  x  1). 
An  uncontrollable  cell  is  a  cell  which  despite  the  given  input  will  always 
lead  to  a  saturated  state.  An  element  is  "1"  if  the  corresponding  cell  is 


an  uncontrollable  cell  and  a  "0" 

if 

it  is 

controllable. 

voltage 

lower  bound  i 

A  (n  X 

1) 

array 

containing 

the 

minimum 

voltage  of 

the  A/D 

converter  for 

each  input. 

(input 

by  user) 

vol tage 

_lower  bound  s 

A  (n  X 

1) 

array 

containing 

the 

minimum 

voltage 

of 

the  A/d' 

converter  for 

each  state. 

(input 

by  user) 

voltage 

upper  bound  i 

A  (n  X 

1) 

array 

containing 

the 

maximum 

voltage  of 

the  A/d' 

converter  for 

each  input. 

(input 

by  user) 

vol tage 

_upper  bound  s 

A  (n  X 

1) 

array 

containing 

the 

maximum 

vol tage 

of 

the  A/d' 

converter  for 

each  state. 

(input 

by  user) 

3.0.  FILES 

Four  files  may  be  created  during  the  execution  of  "DTQD." 
3.1.  job  name . DATA 


This  file  contains  all  of  the  above  external  variables  which  may  be  entered 
by  the  user,  except  job_name.  The  file  is  created  via  the  subroutine 
CREATE_DATA_FILE  of  the  procedure  DTQD.  Although  the  procedure 
CHANGE_PARA METERS  is  designed  to  allow  the  user  to  enter  or  modify  the  data 
in  this  file,  minor  changes  can  be  made  easily  using  the  text  editor. 

3.2.  job  name. NEXT  STATE 

This  file  is  actually  just  a  way  of  preserving  the  variable  next_state_map. 
As  stated  in  the  previous  section,  this  file  contains  the  next  state  for 
each  state/input  combination.  The  next  state  is  stored  in  coded  form  as  an 
integer  and  is  retrieved  via  the  coded  state  and  input. 
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3.3-  Job  name. CONTROL  LAW 


This  file  contains  the  optimal  control  law  for  the  system.  The  file  is  in 
the  form  of  a  one-dimensional  array  of  length  equal  to  the  n'omber  of  cells 
(i.e.  the  number  of  state  combinations).  The  control  law  is  stored  as  an 
integer-coded  input. 

3.4.  job  name  ts.PLOT 


This  file  contains  each  state  and  input  for  every  time  interval  that  the 
system  was  simulated.  It  is  this  file  that  is  used  to  make  plots  of  the 
simulation. 

4.0.  PROCEDURES 

The  program  is  divided  into  six  basic  procedures,  each  part  containing 
several  sub-procedures.  Figure  B-1  is  a  flow  diagram  of  the  program  which 
describes  the  interaction  between  these  processes.  Each  of  the  six  main 
routines  as  well  as  their  respective  internal  subroutines  are  discussed  in 
separate  sections  below. 

4.1.  DTQD 


This  procedure  calls  10  subroutines,  six  of  which  are  external  procedures. 
It  is  one  of  the  six  basic  sections  of  the  entire  program,  the  Main  Menu. 
The  purpose  of  this  routine  is  to  act  as  a  menu  so  that  the  user  can  access 
the  other  five  parts  of  the  program.  The  internal  subroutines, 
(CREATE_DATA_FILE ,  F RE E_C0NT R_E XTE RN_ V ARS ,  SAV E_QUANT_FILE ,  and 
CLOSE_FILES) ,  are  called  when  the  user  is  preparing  to  stop  execution  of 
the  program. 

4.1.1.  CREATE_DATA_FILE.  This  internal  subroutine  is  called  by  DTQD  to 

save  the  data  pertaining  to  the  current  job  in  a  file  named  job_name.DATA. 
(See  section  3.1  of  this  appendix)  The  variables  are  saved  only  if  they 
have  been  allocated  and  set  for  the  current  job,  either  by  accessing  a 
previous  data  file  or  creating  them  in  an  appropriate  routine.  The 
variables  which  are  always  saved  in  this  file  are:  title, 

f 1 ag.cont_exists ,  f 1 ag.di screts_exi sts  ,  f 1 ag .quant i ze d_ex i s ts , 
flag.control_law_val id,  f lag.sim_val id,  flag.own_quant_f ile_exists.  If  any 
model  of  the  system  is  valid  or  if  a  control  law  has  been  accessed,  the 
variables  n  and  p  are  saved.  If  a  continuous  model  of  the  system  exists, 
a_matrix  and  b_matrix,  are  recoreded  in  the  file.  Similarly,  if  a 
discrete_time  model  exists,  phi_matrix,  1 ambda_matrix,  and  tau  are  saved. 
If  a  quantized  model  exists,  number_of_steps_s ,  number_of_steps_i , 
voltage_upper_bound_s,  voltage_lower_bound_s,  voltage_upper_bound_i ,  and 
vol tage_lower_bound_i  are  saved.  Finally,  if  a  control  law  is  valid  for 
the  current  job,  cost_f unction_code ,  s t at e_cos t_mat r i x ,  and 
input_cost_matrix  are  saved  in  the  file  j ob_name.data  as  well. 

4.1.2.  FREE_CONTR_EXTERN_VARS.  This  routine  frees  all  of  the  controlled 
external  variables  used  in  the  program. 
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4.1.3.  SAVE_QUANT_FILE.  In  this  subroutine,  the  user  has  the  opportunity 
to  have  the  next  -  state  array  saved  in  a  file.  The  advantage  of  having  a 
file  saved  is  that  it  need  not  be  rebuilt,  just  read  in,  the  next  time  that 
the  job  is  accessed.  However,  if  the  file  is  very  large,  it  may  not  be 
advantageous  to  have  it  take  up  so  much  space,  and  the  user  may  opt  to 
rebuild  it  each  time.  If  the  user  does  choose  to  have  the  array  saved  in  a 
file,  the  variable  flag.own_quant_f ile_exists  is  set  to  "1." 

4.1.4.  CLOSE_FILES.  This  suboutine  closes  the  next  -  state  and  control 
law  files  by  adjusting  the  bit  count  for  the  for  the  files 
j ob_name.next_state,  and  job_name.control_law. 

4.2.  INIT 


The  second  basic  part  of  the  program  is  INIT.  This  procedure  is  called  by 
DTQD  when  the  program  is  initially  executed  and  any  time  that  the  user  opts 
to  re-enter  the  initialization  process.  In  this  section  the  program 
prompts  the  user  to  enter  the  job  name.  The  user  can  start  a  new  job, 
access  an  old  job,  or  modify  an  old  job  file.  If  the  user  accesses  an  old 
job  file,  GET_DATA_FILE  is  called.  If  the  user  starts  a  new  job, 
GENERATE_PARAMETERS  is  called.  If  the  user  modifies  an  existing  job,  the 
data  file  from  the  old  job  is  copied  to  create  a  new  file  and  GET_DATA_FILE 
is  called. 

4.2.1.  GENE RATE_PARA METERS.  This  subroutine  prompts  the  user  to  enter  the 
title  for  the  job  file,  and  then  calls  CHAN GE_PARA METERS. 

4.2.2.  GET_DATA_FILE.  This  subroutine  is  called  to  read  in  the  data  from 
the  data  file  job_name.data.  The  title  of  the  job  or  data  file  is  printed 
on  the  screen  and  the  user  is  asked  if  it  is  the  correct  file.  If  so,  the 
data  may  be  read  in,  depending  on  the  value  of  the  five  status  flags.  Just 
as  in  CREATE_DATA_FILE  (See  section  4.1.1.  of  this  appendix),  if  a  certain 
model  of  the  system  has  been  created,  or  if  a  certain  piece  of  the  job  has 
been  completed,  then  the  corresponding  data  may  be  read  in.  A  subroutine  of 
CHANGE_PARAMETERS  called  BUILD_MISC_ARRAYS  is  also  called.  Depending  on 
the  value  of  the  variable  f lag.own_quant_f ile_exists,  a  file  containing  the 
next  -  state  array  is  accessed  or  the  subroutine  of  CHANGE_PARAMETERS, 
BUILD_NEXT_STATE_FILE ,  is  called  to  generate  the  array.  Also  the 
procedure,  BUILD_CONT_REG_SAT_EDG_ARRYS,  another  subroutine  of 
CHANGE_PARA METERS,  is  called. 

4.3.  CHANGE  PARAMTERS 


The  third  basic  section  of  the  program  is  the  data  modif ication  section. 
In  this  procedure,  the  user  can  change  the  parameters  of  the  continuous  - 
time,  discrete  -  time,  and/or  the  quantized  models  of  the  system.  This 
routine  may  be  called  by  DTQD  or  by  the  subroutine  of  INIT, 
GENE RATE_PARA METERS. 

Upon  entering  the  program  the  user  is  asked  which  model  is  to  be  moaified. 
If  the  continuous  -  time  model  is  chosen,  the  user  is  asked  which 
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parameters  of  the  model  are  to  be  changed.  If  the  continuous  -  time  model 
does  not  currently  exist  for  the  job,  the  program  assumes  that  the  user 
wants  to  create  the  continuous  system  and  so  the  user  will  be  prompted  to 
enter  all  the  parameters  for  the  model. 

If  the  discrete  -  time  model  is  chosen  to  be  modified,  the  user  may  change 
the  parameters  of  the  discrete  system  as  can  be  done  in  the  modification 
process  of  the  continuous  -  time  model.  If,  however,  the  continuous  -  time 
model  for  the  system  currently  exists,  the  user  can  have  the  program 
generate  the  discrete  -  time  model  by  asking  the  user  to  enter  the  sampling 
period,  tau,  and  calling  the  subroutine  BUILD_DISCRETE_MATRICIES. 

If  the  user  chooses  to  modify/ create  the  quantized  model  of  the  system,  the 
parameters  of  the  A/D  converter  must  be  entered.  Next,  the  subroutine 
BUILD_MISC_ARfiAYS  is  called.  The  user  is  then  given  two  choices:  have 
the  program  generate  the  next  -  state  array,  or  access  a  file  containing  a 
next  -  state  array.  The  subroutine  BUILD_CONT_REG_SAT_EDG_ARRYS  is  then 
called . 

4.3.1.  BUILD_DISCRETE_MATRICIES.  This  subroutine  creates  the  discrete 
system  matricies  (phi_matrix  and  lambda_matrix)  from  the  continuous  -  time 
matricies  (a_matrix  and  b_matrix).  The  discrete  -  time  system  matrix,  phi, 
is  created  by  setting  all  the  Inputs  and  states  equal  to  zero  except  the 
ith  state  which  is  set  to  1.  The  value  of  the  state  after  one  time 
constant  is  then  determined  and  the  new  state  is  set  equal  to  the  ith 
column  of  phi_matrix.  To  find  the  discrete  -  time  input  matrix,  a  similar 
procedure  is  followed.  However,  this  time  the  ith  input  is  set  to  1 
instead  of  the  ith  state.  The  change  in  state  is  found  using  the  sixth 
order  Runga-Kutta  differential  equation  solver  IMSL_DVERK. 

4.3- 2.  BUILD_MISC_ARRA YS.  This  subroutine  initializes  the  variables 
quantum_step_si ze_s ,  quantum_step_si ze_i  ,  offset_s,  offset_i, 
num_state_combs,  and  num_lnput_combs. 

4.3.3-  BUILD_CONT_REG_AND_SAT_EDG_ARRYS.  This  procedure  builds  the 
uncontrollable  cell  and  saturated  edge  arrays.  The  variable 
num_controllable_cells  is  set  to  the  number  of  controllable  cells. 

4.3.4.  BUILD_NEXT_STATE_FILE.  This  procedure  builds  the  quantized  data 
array,  next_state_map.  The  routine  runs  through  every  possible  state  and 
input  combination,  converts  the  state/input  coded  version  to  its  discrete  - 
time  state  and  input  arrays  respectively,  and  determines  the  next  state 
using  the  equation: 

x(k  +  1 )  =  $  x(k )  +  A  u(k ) 


where , 

x(k)  and  u(k)  are  the  discrete  -  time  state  and  input  arrays 
respectively , 

$  is  the  discrete  -  time  system  matrix,  phi  matrix, 

A  is  the  discrete  -  time  input  matrix,  lambda  matrix. 
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Each  next  -  state  is  checked  for  saturation.  if  saturation  is  found,  the 
next  state  is  converted  to  the  coded  form  and  is  added  to  the  array, 
next  state  map.  Otherwise,  a  zero  is  added  to  the  file  signifying 
satuFation.” 

M.4.  PRINT  IT 


The  fourth  basic  section  is  basically  a  menu  which  allows  the  user  to 
examine  various  arrays  and  files.  The  subroutine  DISPLA Y_J0B_F ILE ,  is 
called  to  display  the  parameters  of  the  continuous-  time  model,  discrete  - 
time  model,  or  the  A/D  converter,  PRINT_NEXT_STATE_FILE  and 
PRINT_CONTROL_LAW  are  called  to  display  the  next  -  state  array  and  control 
law,  respectively.  CHECK_QUANTIZATION_LEVEL  is  called  if  the  user  wishes 
to  have  a  check  done  on  the  quantization  levels  of  the  system. 

4.4.1.  DISPLAY  J0B_FILE.  This  procedure  has  not  yet  been  written. 
However,  when  completed,  it  will  allow  the  user  to  display  any  of  the 
parameters  saved  in  the  data  file  job_name.data. 

4.4.2.  PRINT_NEXT_STATE_FILE.  This  procedure  prints  the  next  state  code 
for  each  state/input  combination. 

4.4.3.  CHECK_QUANTIZATION_LEVEL.  This  subroutine  the  user  make  a  crude 
check  on  the  quantization  of  the  system.  The  check  is  done  in  two  parts. 
The  first  is  a  summary  of  the  cells  moved  from  each  state  given  a  zero 
input.  The  number  of  cells  moved  in  each  direction  and  the  total  number  of 
cells  moved  are  computed  and  displayed.  The  second  part  of  the  report 
checks  the  number  of  cells  moved  from  the  zero  state  for  each  input  at  its 
smallest  value.  If  the  smallest  value  results  in  saturation,  the  smallest 
value  which  results  in  a  non-saturated  next  state  is  used.  The  results  are 
reported  for  each  input,  with  the  number  of  cells  moved  in  each  direction 
and  the  total  number  of  cells  moved  being  printed  out.  In  this  part, 
unlike  the  first,  the  cell  movement  is  described  by  an  absolute  and  average 
value.  The  absolute  value  is  just  the  number  of  cells  moved  for  each 
input.  The  average  value  is  the  absolute  value  divided  by  the  number  of 
steps  between  the  smallest  non-saturating  input  and  the  zero  input. 

After  displaying  the  summary,  the  subroutine  PRINT_SAT_EDGE_ARRAY  is  called 
and  the  user  can  have  the  saturation  edge  array  printed.  This  array  has 
the  same  matrix  format  as  the  next-state  array,  but  the  elements  are 
displayed  as  either  an  "F"  or  a  "T."  A  "T"  is  displayed  if,  given  the 
corresponding  input,  the  cell  leads  to  saturation  or  to  an  uncontrollable 
cell.  If  not  every  cell  is  controllable,  the  user  can  print  the 
uncontrollable  cell  array  which  will  print  the  codes  for  each 
uncontrollable  cell. 

4.4.4.  PRINT_CONTROL_LAW.  This  subroutine  allows  the  user  to  print  the 
coded  form  of  the  control  law. 
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M.5.  build  TOL  REG  AND  CONT  LAW 


This  is  another  basic  section  of  the  program.  It  is  this  procedure  which 
builds  the  tolerant  region  and  the  control  law. 

4.5.1.  BUILD_COST_FUNCTION.  This  is  the  first  subroutine  called  if  the 
user  wishes  to  build  a  control  law.  The  user  is  prompted  to  enter  the 
desired  cost  function  and  if  necessary  the  state  and  input  weighting 
matricies.  The  user  can  use  a  minimura_time ,  minimum  control  effort,  or 
quadratic  cost  function.  If  none  of  these  are  desired,  an  external  file 
containing  a  control  law  may  be  accessed,  or  the  user  may  write  a  routine 
containing  a  custom  cost  function  for  the  control  law  to  implement. 

4.5.2.  GET_TOLERANCES.  In  this  procedure,  the  user  is  prompted  to  enter 
the  tolerances  necessary  to  find  the  tolerant  region 
(cent er_cel l_t ol er ance )  and  to  compensate  for  edge  irregularities 
(edge_cell  tolerance). 

4.5.3.  INITIALIZE_CELL_STATUS_ARRAY.  The  array  cell_status  is  initialized 
in  this  procedure.  This  array  is  one  dimensional  with  length  equal  to 
num_state_combs.  The  procedure  uses  the  variable  edge_cel l_tol erance  set 
in  GET_TOLERANCES  to  determine  the  "edge  cells."  The  array  is  then 
initialized,  giving  each  element  one  of  the  following  values: 

2:  if  the  cell  is  an  edge  cell 
1  :  if  the  cell  is  uncontrollable 
0:  otherwise 

As  in  section  5.2.4.13.,  the  quantized  model  of  a  second  order  system  may 
be  thought  of  as  a  cell  plane.  Keeping  this  in  mind,  a  typical  second 
order  system  with  a  edge_cel l_tol erance  of  one  might  have  an  initialized 
cell  status  array  ressembling  the  following: 


1 

2 

2 

2 

1 

2 

0 

0 

0 

2 

2 

0 

0 

0 

2 

2 

0 

0 

0 

2 

1 

2 

2 

2 

1 

4.5.4.  INITIALIZE_CENTER_DIST_ARRAY.  Another  book-keeping  array, 
center_dist,  is  initalized  in  this  procedure.  This  routine  uses  the 
variable  center_cel l_tol erance  which  was  set  in  GET_TOLERANCES  to  determine 
the  tolerant  region.  The  one  dimensional  array  of  length  equal  to  the 
num_state_combs  is  then  initalized.  Each  of  the  elements  (i.e.  state 
codes)  is  assigned  a  value  equal  to  its  distance  from  the  origin.  If  this 
distance  is  greater  than  the  center  cell  tolerance,  however,  the  element  is 
set  equal  to  zero. 

If  the  value  of  center_cel  l_tol  erance  was  chosen  to  be  two,  the  initialized 
center  dist  array  for  a  two  dimensional  system  might  look  like: 
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0 

0 

0 ! 

0 

0 

0 

0 

2 

2 

2 ' 

2 

2 

0 

0 

2.. 

1 

1 

1 

2 

0 

0 

2 

1 

0  ■ 

1 

2 

0 

1  0 

2 

1 

1 

1 

0 

0 

2 

2 

2 

2 

0  , 

- - ^ i - i 

0  0,010  0;0'0i 


4.5.5.  FIND_ROOT_CELLS.  This  procedure  finds  the  roots  cells  to  create  the 
tolerant  region  and  control  law.  Each  zero-valued  element  of  the  array 
cell  status  is  considered  unmarked.  This  procedure  marks  each  of  the 
elements  by  implementing  the  following  integer  codes: 

0:  cell  is  unmarked 

1  :  cell  is  uncontrollable 

2:  cell  is  in  the  edge  tolerant  region 

3:  cell  is  the  zero  state  cell 

4:  cell  is  reachable  to  a  cell  coded  with  3 

5:  cell  is  another  root  cell 

6:  cell  is  reachable  to  a  cell  coded  with  5 

i:  cell  is  another  root  cell 
i  +  1:  cell  is  reachable  to  a  cell  coded  with  "i" 

4.5.6.  0PEN_C0NTR0L_LAW_FILE.  This  routine  opens  the  control  law  file  and 
initializes  the  control  law  array. 

4.5.7.  FIND_L00PS_AND_C0NTR0L_LAW.  In  this  procedure,  the  loops  within 
each  subtree  (denoted  by  a  separate  root)  are  looked  for  within  the  center 
cell  tolerant  region.  If  a  loop  is  found,  the  control  law  for  the  tolerant 
region  is  defined.  If  this  can  be  done  the  procedure 
BUILD_0PTIMAL_C0NTR0L_LAW  is  called. 

4.5.8.  BUILD_0PTIMAL_C0NTR0L_LAW.  This  procedure  builds  the  control  law 
one  cell  at  a  time  for  the  remainder  of  each  of  the  subtrees  by  creating  an 
optimal  spanning  tree  based  on  the  weighting  matricies  and  cost  function 
previously  defined  by  the  user. 

4.6  SIMULATE  SYSTEM 

The  procedure  SIMULATE_SYSTEM  simulates  the  closed  loop  system  and 
implements  the  imbedding  process.  The  user  is  first  prompted  to  enter 
necessary  parameters  such  as  the  number  of  imbedding  levels,  the  scaling 
factor,  the  initial  state  and  time,  and  the  final  time.  Using  the  external 
subroutine  OWN  SYS  TO  SIM.pl 1,  the  user  can  simulate  a  continuous  system 
which  is  different  from  the  original  system  that  the  control  law  was 
developed  for.  The  system  used  in  0WN_SYS_T0_SIM  must  have  at  least  as  many 
states  as  the  original  system  that  the  controller  was  designed  for.  If  it 
has  more  states,  the  states  which  were  initially  used  to  develop  the 
controller  must  be  the  first  states  of  the  new  system. 
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The  simulation  starts  with  a  check  for  saturation  and  controllability. 
Next,  the  magnitude  of  each  state  is  studied  and  the  proper  imbedding  level 
is  evaluated  by  calling  the  subroutine  FIND_REGION.  If  one  sampling 
interval  has  elapsed,  the  control  law  is  accessed  to  obtain  the  proper 
inputs.  The  control  inputs  are  scaled  to  the  proper  size  for  the 
corresponding  imbedding  level.  The  sixth  order  Runga-Kutta  differential 
equation  solver  IMSL_DVERK  is  then  called  to  find  the  value  of  the  state 
after  one  simulation  step.  The  process  is  repeated  until  the  final  time  is 
reached  or  until  a  state  saturates.  After  the  simulation  is  completed  the 
subroutines  BUILD_SIM_DATA_FILE  and  CHOOSE_YOUR_PLOT  are  then  called. 

4.6.1.  BUILD_SIM_DATA_FILE.  This  subroutine  puts  the  simulated  data  in  a 
file  title  j ob_name_ts.pl ot  if  the  user  wishes.  The  simulation  status 
flag,  f lag.sim_val id,  is  set  only  if  the  data  is  saved. 

4.6.2.  CHOOSE_YOUR_PLOT.  Whether  or  not  the  simulation  was  successful, 
this  subroutine  is  called  and  the  user  can  plot  the  data.  If  the  user 
wishes  to  make  a  graph,  the  program  will  ask  for  the  other  parameters  to  be 
entered.  Any  state  and/or  input,  as  well  as  time  may  be  plotted  on  either 
axis.  Also,  more  than  one  plot  can  be  made  using  the  same  title,  axis 
labels,  and  grid.  Using  the  MULTICS  procedures  PLOT,  PLOT_$SCALE,  and 
PLOT_$SETUP,  the  program  will  proceed  to  plot  the  desired  simulation  data. 

4.7.  Miscellaneous  Routines 


Many  of  the  procedures  listed  above  call  the  following  miscellaneous 
external  subprograms:  NUM_ANSWER_OK,  YN_ANSWER_OK,  and  CONVERT_. 

4.7.1.  YN_ANSWER_OK.  This  procedure  checks  the  response  by  the  user 
whenever  a  yes/no  answer  is  required.  The  routine  will  only  accept  "y", 
"yes",  "n",  or  "no".  If  an  incorrect  response  is  entered,  the  program 
prompts  the  user  to  try  again. 

4.7.2.  NUM_ANSWER_OK.  This  procedure  checks  the  user's  response  whenever 
a  menu  selection  is  expected.  The  program  only  accepts  an  integer  which 
represents  a  possible  choice.  If  an  incorrect  response  is  entered,  the 
user  is  asked  to  re-enter  his  choice. 

4.7.3.  CONVERT_.  This  procedure  consists  of  six  entries.  An  entry  is 
called  to  convert  the  current  representation  of  the  state  or  input  array 
into  another  representation.  The  arrays  may  be  in  a  continuous,  discrete, 
or  coded  form.  The  continuous  version  is  that  which  has  a  range  of 
I  ower_voI  tage_bound  to  upper_vol  tage_bound.  The  discrete  form  takes  on 
distinct  values  in  the  range  of  0  and  number_of_steps  for  each  state  or 
input.  Finally,  the  coded  version  gives  each  possible  state  combination 
and  input  combination  a  distinct  integer  code. 
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1.0  PROGRAM  LISTING  FOR  "DTQD" 


The  following  pages  contain  the  pl/1  code  for  the  program  DTQD.  The 
listings  are  organized  into  six  basic  procedures  as  discussed  in  Appendix 
B.  DTQD  is  first  followed  by  init,  change_p ar am e t er s ,  print_it, 
build  tol  reg  and_cont_law,  simul ate_system,  and  finally  some  miscellaneous 
routines . 

For  reference,  the  above  procedures  as  well  as  their  major  subroutines  are 
listed  below  in  alphabetical  order  with  corresponding  page  numbers. 


build_cont_reg_sat_edg_arrys . C-28 

build_cost_f  unction . C-42 

build_discrete_matricies . C-25 

build_misc_arrays . C-27 

build_next_state_f  ile . C-29 

build_optiraal_control_law . C-53 

build_sim_data_f  ile . . . C-64 

bulld_tol_reg_and_cont_law . C-41 

change_parameters . . . . . .  .C-1 5 

checl<_quantizatlon_level . C-3^ 

choose_your_plot . C-66 

close_f  lies . C-7 

convert  . . C-76 

create_data_f  ile . C-2 

display_job_file. . . C-32 

DTQD . C-2 

f  ind_loops_and_cont_law. . . . C-50 

f  ind_root_cells . C-46 

free_contr_extern_vars . . . C-5 

generate_parameters . C-1 0 

get_data_f  ile . . . . . .  .0-1 1 

get_tolerances . C-44 

init . . . . . . C-8 

initialize_cell_status_array. . . C-44 

initialize_center_dist_array. . . C-45 

num_answer_ok . C-78 

open_control_law_f  ile. . . C-50 

own_sys_to_sim . C-72 

print_it . . . C-31 

print_control_law . C-57 

print_next_state_f  ile . C-33 

save_quant_f  ile . C-6 

simulate_system.  . . C-58 

yn  answer  ok . C-7 9 
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OTQO:  Drocsdure  oDticrs  (main); 

del  choice  fixed; 

del  choice  char  character  (1); 

del  range  Tixed." 

del  done  bit(1); 

ocl  f i r s t_ i n i t _ f L a q  bit(1); 

del  sy s  1  n  file#* 
del  sysorint  file; 
del  dat  a_f i le  file; 

ocl  nu an s we r _o k  entry  (character  (1)/  fixed/  fixed); 

ocl  init  en t r y ~ ( b i t ( 1  )  /  file); 

del  orint^it  entry; 

del  c h an ge_Da r ame t e rs  entry; 

del  build_tal_reg_aPd_cont_law  entry#* 

del  s i mu  I  a t e_ s y s t em  entry; 

first^init  flag  =  '*1''b; 

call  init  (first  init  flag/  data_file); 

done  =  "0"b; 

do  while  (done  =  "Q'*b); 

put  edit  ('*1>  Initialize”)  (skip/  a); 

put  edit  <"2)  Modify  Data  Pile")  (skip/  a).* 

out  edit  <”3)  Print  Files”)  (skip/  a); 

put  edit  (”4)  Build  Control  Law”)  (skip/  a); 

put  edit  (”5)  Simulate”)  (skip/  a); 

put  edit  <"6)  Quit”)  (skip/  a); 

out  edit  (“Enter  choice  ==>  ”)  (skip  (2)/  a); 

get  list  ( c ho i ce^ c h ar )  ; 
range  s  67 

call  num_an swe r_o k  (eh o i ce^ch a r /  range/  choice)^ 
goto  case  (choice); 

case(1):  if  (first_init_flag  *  ”0”b)  then  do; 

call  s a ve_quan t _f i I e ; 
call  create^data.f i  le; 
end; 

call  init  ( f i r s t_ i n i t_ f I  a g/  data.file); 
goto  end. case; 

case  (2);  call  c hang e.par ame te r s 7 

goto  end.case; 

case  (3):  call  print. it; 

goto  end.case; 

case  (4);  call  build_tol.reg_and_cont_law; 
goto  end. case; 

case  (5):  call  simulate. system; 
goto  end. case; 
case  (6);  done  =  ”1”b; 
end.cas  e : 
end;  /*  while  * / 

if  (first. init. flag  =  ”Q”b)  then  do; 
call  sa ve.qu a n t_ f i  le ; 
call  create  data. file; 
end#* 

call  f r ee. con t r . ex t e r n.v a r s ; 
call  close,  files#* 

c r ea t e.d a t a. f i I e :  procedure; 

del  job  name  character  (50)  varying  external; 
del  title  character  (70  varying  external; 

del  true  bit(1)  initial  (”1”b)7 
del  false  bit(1)  initial  (”Q"b); 
del  1  flag  external/ 

2  cont. exists  bitd)/ 

2  d i sc r e t e. e X i s t s  bit(1)/ 
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2  quan t i 2 e d_ ex i s t s  bit(l)# 

2  cont r o I  au^v a li d  bitC1)^ 

2  s  i  m_  V  a  1 1  d  b  i  t  ( 1  )  ^ 

2  own.quant_file_exists  bit(1); 

del  next.state.file.ptr  pointer  external; 

del  own^quan t_ da t a_ t i t  I e  charaeter  (70)  external; 

ael  n  fixed  external; 
del  o_real  fixed  external; 
del  p  fixed  external; 

del  a^ matrix  <1:n#  1:n)  float  eontrolled  external; 
del  matrix  (1:n#  1:p)  float  eontrolled  external; 

del  tau  float  external; 

del  phi  matrix  <1:n/  1:n)  float  eontrolled  external; 
del  lambda^ma t r i X  (1:n^  1:p)  float  eontrolled  external; 

del  number_of:_  St  eps.s  (1:n)  fixed  eontrolled  external; 
del  \ro  1 1  age^uppe  r^bcun  d_s  <1;n)  float  controlled  external; 
del  vo 1 1 age_ I  owe r_bcund_s  (1:n)  float  controlled  external; 

del  number_of _ste'ps.i  <1:p)  fixed  controlled  external; 
del  vo I t age_upper_bcund_i  (1:p)  float  controlled  external; 
del  wo  1 1 age.l 0 wer_bcund_ i  <1:p)  float  controlled  external; 

del  cost^func t i on_code  fixed  external; 

del  state^cos‘t_matrix  (1:n)  float  controlled  external; 
del  i npu t_cos t^ma t r i X  (1:p)  float  controlled  external; 

dcldata^filefile; 

/*  The  above  variables  are  stored  in  the  same  order  as  decla 
red  */ 

del  skip^amount  fixed; 
del  i  f i xed; 
del  j  fixed; 

/*  ****  */ 


open  file  <data_file)  title  (”vfile_  "lljob  name  I  I da t a")  s 
tream  output; 


/*  */ 


put  file  (data^file)  edit  ( ti t  le) < ski p^  a(70)); 


put  file  (data^file)  edit 
put  file  (data^file)  edit 

put  file  (data_file)  edit 

)  ; 

put  file  (data.file)  edit 
)  )  ; 

put  file  (data_file)  edit 
put  file  (data_file)  edit 
b  <  1  )  )  ; 


< f I ag, cont_ex i St s ) ( s k i 0/  b(1)); 
(flag. discrete_ exists) (skip^  b(1) ) 

(flag,quantized_exists) (skip/  b(1  ) 

(flag.control_law_valid) (skip^  b(1 

(  f I ag. s i m_v a  I i d) ( s k i p /  b(1)); 
(flag.own_quant_fi le_exi sts) (skip^ 


if  ( f I  a g. c ont _ e X i s t s  =  t rue  I f I ag.d  i  sc rete  exists  =  truelflag 
. quan t i zed.ex i s t s  *  t rue  I  f  I  ag . con t r o  l_ I  a w  valid  =  truelflag. si 
m_valid  =  true)  then 
do; 

put  file  (d3ta_file)  edit  ( n) ( s k  i  p^ f ( 5  )  )  ; 
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end  ; 


out  file  (dat3_file)  edit  (p)(skip#  f(5)); 


if  ( f L ag. cont _ ex i s t s  =  true)  then 
do ; 

do  i=1  ton; 
do  j=  1  tc  n; 

out  file  (data.file)  edit 

f(12r  4))» 

end; 

end; 

do  i  =  1  to  n; 
do  j  =1  to  p; 

put  file  (data  file)  edit 

f  ( 1  2  ^  4  )  )  ; 

end; 

end; 

end; 


(a.matri*  (i/j))(s)<io/ 


(b_ matrix  (i#j))(skip# 


if  (  f  I  aq,  di sc r et e_ex i s t s  =  true) 
do; 

put  file  (data  file)  edit 
do  i  =  1  to  n; 
do  j  =  1  ton; 

put  file  ( data  file) 

ip#  f(12/  4)); 

end; 

end; 

do  i  =  1  to  n; 

do  j  =1  to  p; 

put  file  (data  file) 
(skip#  f (1 2#  4) ) ; 

end; 

end; 

end; 


then 

(tau)(skip#  f(12#  4)); 


edit  (phi_matrix  (i#  i))(sk 


edit  (  I  ambda_ma t r i X  (i#  j)) 


if  (f  I  ag.quant i 2ed_ex i Sts  =  true  I  flag. own  quant  file  exist 
s  a  true)  then  -  -  - 


do; 

do  i  =  1  to  n; 

,  .  put  file  (data. file) 

kio#  f(5)); 

end; 

do  i  a  1  to  n; 

put  file  (data^f i le) 
#  VO  1 1  ag  e_  I ower_, boun d_s  {  i  T) 

(skip 

end; 

do  i  a  1  to  p; 

put  file  (data  file) 

kip#  f (5 ) ) ; 

end; 

do  i  a  1  to  p; 

put  file  (data  file) 
)#  vo I t a g e_ t owe r _bo un c_ i  Ti)) 

2  #  4  )  )  ; 

end; 


edit  (number^of .steps.s  (i))(s 

edit  ( VO  I t age_upoe r_bound_ s ( i  ) 
f  ( 1  2  #  4  )  #  X  (  3 )  #  f  ( 1  2  #  4  )  )  ; 

edit  (num be r_of _ s t ep s_i  (i))(s 

edit  ( V o I t a ge _u p pe r_b oun d_ i  (i 
(skip#  f (12#  4)#  x(3)#  f  (1 


if  (flag.own  quant  file.exists  =  true)  then 

out  file  vdata.file)  edit  ( own_quan t _da t a_ t i t I e ) ( s k i o#  a( 
7  G  )  )  /  ** 

else 

put  file  (data_file)  skip; 
end  ; 
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i  f 

s  k  i  p  ^  f  (  5  )  ) 

a  t  r  i  X  (  i  )  ) 

)  ; 


=  3)  then 

a  t  r  i  X  ( i )  ) 
)  ; 


( f La g . c on t ro I  I  aw  valid  =  true)  then 
do; 

put  file  (data.file)  edit  ( co s t ^ f u n c t i on_ c ode )  ( 

$ 

if  ( c o s t_ f un c t i on^code  =  2)  then 
do ; 

dc  i  =  1  to  n; 

out  file  (data.file)  edit  ( s  t  a  t  e_  co  s  t 

(skip^  f(12/4) 

end ; 
end; 

if  ( c 0 s t_ f unc t i on^c ode  =  2  I  co s t _ f unc t i on_ c ode 
do ; 

do  i  3  1  to  p; 

put  file  (data_file)  edit  Cinput.cost^m 

(skip/  f(12/4) 


end  ; 
end; 

end; 


close  file  (data^file); 

end  c  r  e  at  e_d a  t  a_  f  i  le; 
free^contr_extern_vars:  procedure; 

del  n  fixed  external; 

del  0  fixed  external; 

del  num;_s  t  a  te^  com  b  s  fixed  external; 

del  num_ i nput_ c omb s  fixed  external; 

del  number_of_sted5.s  (1:n)  fixed  controlled  external; 
del  number_of  steps  i  (1:p)  fixed  controlled  external; 
del  off^et.s  Tl:n)  fixed  controlled  external; 
del  offset^i  (1:p)  f i x ed  cont rol I ed  external; 
del  duantum_s t ep^s i ze. s  <1:n)  fixed  controlled  external; 
del  quantum_s t ep^s i ze_ i  <1:o)  fixed  controlled  external; 

del  VO  1 1 age_upoer_boun d_s  (1:n)  float  controlled  external; 
del  vortage_lower_bcund_s  (1:n)  float  controlled  external; 
del  VO  1 1 age_uppe r _bcun d_  i  <1:o)  float  controlled  external; 
del  voltage^lower_bcund.i  (1;p)  float  controlled  external; 
del  phi^matrix  (1:n#  1:n)  float  controlled  external; 
del  I amb da_ma t r i X  (1:n/  1:p)  float  controlled  external; 

del  next  state^map  (1 : num^state_combs^  1 : num_ i nput.combs )  fi 
xed  controlled  external; 

del  uncont rol I ab I e_cel L  (1;num  state^combs)  bit(1)  controlle 
d  externa-i; 

del  sat^edge  ( 1  ;  n  utr_s  t  a  t  e^  corabs^  1:num_input  combs)  bit(1)  c 
ontrolled  external; 

free  number_o f _st eos_s ^  number_of_steps_ i ^  offset.s#  offset 
i  ;  ~ 

free  qua n t um_ s t eo_ s i z e _ s ^  quant um_ s t ep_ s i z e_ i ; 

free  v o I taqe_u ppe r _bou nd_s ^  vo I t age_ I ou e r _boun d_ s ; 
free  vo I t aqe_ uooe r_bou nd_ i /  vo I t age_l owe r_b ou n d_ i ; 
free  ohi_matrix^  I ambd a _ma t r i x ; 
free  nex t^sta t e_map ; 

free  unc ont ro I L ab  I  e_ce  I  I  ^  sat_edqe; 
end  f r ee_ c on t r_ e X t e r n _v a r s ; 
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s ave_auant_ f i Le :  prccedure; 


del  ne * t_ s t a t f i L e_p t r  pointer  external; 
del  num.'s  ta  te_comb  s  •fixed  external; 
pel  num3 i nput. e omb s  fixed  external; 

del  next.state.map  (1:num_state_combs/  1:num_inDut_combs)  fi 
xed  controlled  external; 

del  t h e_ ne X t_ s t a t e  mapping  ( 1 ; num_ s t a t e. c ombs /  i  :num_ i nout_ c 
ombs)  Hxed  binaryll?)  unsigned  based  ( ne x t_ s t a r e_ f i  I e_o t r ) ; 
del  job.name  c h a r a c t e r ( 50)  varying  external; 
del  oun.qua n t_d a t a. t i t I e  character  (70)  external; 

del  true  bit(1)  initial  ('*1**b); 
del  falsebit(l)  initial  (**0”b); 
del  1  flag  external/ 

2  cont.exists  bitd)/ 

2  di  sc  r  e  t  e  e  xi  s  t  s  bit(1)/ 

2  quan t i z e d.ex i s t s  bit(1)/ 

2  cent r 0 1^ I au^v a  I  i d  bit(1)/ 

2  si m_ valid  bit(l)/ 

2  own^quant.f  i  I  e_ex  i  st  s  bitd); 

del  Morking.dir  c ha rac t er < 1 68 )  external; 

del  bit.count  fixed  bin(24); 

del  code  fixed  bin<25); 

del  answer  character(3)  varying; 

del  i  fixed; 

del  j  fixed; 

del  h c s. S i n i t i a t e_ c cun t  entry  ( c ha r (* ) / c ha r ( * ) / c ha r ( *  )  /  fixe 
d  bin<24)/ 

fixed  bin(2)/  ptr/  fixed  bin( 

3  5)); 

del  h c s_ Sma ke_ s eg  entry  (charC*)/  charC*)/  char(*)/  fixed  bi 
n  <  5)  / 

ptr/  fixed  bin(35)); 
del  delete  entry  options  (variable); 

del  yn^answer^ok  entry  ( c har a c t e r ( 3 )  varying); 

del  sysin  file  input; 

del  sysprint  file  output; 


if  ( f I ag .quan t i zed.ex i s t s  =  true)  then  do; 

out  edit("Would  you  like  to  save  the  quantized  state  file'’ 
>  •’)(skip/a); 

get  list  (answer); 
call  yn_answer_ok  (answer); 
if  (answer  =  "y"  I  answer  =  "yes”)  then 
do; 

if  ( f  I  ag, own  cuan t. f i  I  e_ e X i s t s  =  false)  then 

own.qua n t_ da ta. 1 1 1 1 e  =  j ob.name I  I " . ne x t _s t a t e" ; 


call 

title/  '••'/ 


e_p  t  r  / 


«• 
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code) 

call 

call 


hcs.linitiate^ count  (working_dir,  own_quant_data_ 

bit.count/  0/  ne x t _ s t a t e. f i  I 

delete  ( own_ouan t_d a t a_ t i t I e /  ”-bf”); 
hcs.Smake.seg  (working_dir/  own.quant. data. title/ 

01010b/  ne X t . s t a t e. f i I e_n t r /  code) 


j ) ; 


do  i  =  1  to  num_ s t a t e_c ombs ; 

do  j  =  1  tc  n urn. i npu t_ c omb s; 

the.nex t_ state. m3pping(i/j)  =  next.state.map  (i/ 
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true? 


end; 
end; 

flag.own  auant_file  exists  = 
end; 

end; 

end  save  quanta f i t e ; 
close_fiTes:  procedure; 

del  job.name  character  (50)  varying  external; 

del  1  flag  external# 

2  cont^exists  bitd)# 

2  di sc rete  exi s t s  bit(l)# 

2  quan t i zed.ex i s t s  bit(1># 

2  cent  r  0  l^  I  au^v  a  I  i  d  bitd)# 

2  si  (n_  valid  bit(1)# 

2  own_qua n t_ f i I e_e X i St s  bit(1); 

del  ad j u s t_bi t _c oun t  entry  options  (variable); 

if  (  f  lag, quant  ized.ex  i  sts*  *'1'*b)  then 

call  ad]  ust_bi  t_court  ( j  ofa_name  I  I  ** .  ne  x  t^s  t  a  t  e"  /  ”-ch"); 

if  (  f  I  ag«  cont  r  0 1^  I  au^v  a  I  i  d  =  '*1*'b)  then 

call  ad  j  ust_b  i  t„c  ount  ( j  ob_name  I  I .  con  t  ro  l_  I  aw  ”/  "-ch"); 
end  close_files; 


end  OTQO; 
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init:  Drocedure  (first_init_flag/  data_fiLe)*‘ 

acl  firsts  init, flaa  bitd); 
del  data_Tile  tile? 


del  job_name  character  (50)  varying  external; 
del  workinq_dir  character  (168)  external; 

del  ne X t , s t at e , f i I e_p t r  oointer  external; 
del  control_law_file_ptr  pointer  external; 

del  1  flag  static  external# 

2  cont_exists  bitd)# 

2  discrete _exists  bit(1)# 

2  quan t i z e o.ex i s t s  bit(1)# 

2  c  ont  r  0  I,,  I  au,v  a  I  i  d  bit(1)# 

2  sim_valic  bit(1)# 

2  oun_quant_file_exists  bit(1); 


del  true  bit(1)  initial  (’*1**b); 
del  false  bit(1)  initial  (••0”b); 
del  1  flag2# 

2  done  init  bit(1)# 

2  buila„mode  bitd)# 

2  good,  ]  ob, name  bitd); 

del  good,  j  ob_  t  i  1 1  e  bitd); 

del  choice  fixed; 
dc I  c  c  haracte  r  ( 1  )  ; 
del  range  fixed; 

del  job_name  new  character  (50)  varying; 
del  answer  character  (3)  varying; 
del  bit_count  fixed  bin(24); 
del  code  fixed  bin(35); 

dc I  sys in  file  input; 
del  sysprint  file  output; 

del  null  bu i I t i n ; 

del  unde f i ned f i I e  condition; 


del  num, an swe r _o k  entry  (character  (1)#  fixed#  fixed); 

del  print, it  entry; 

del  eh snge,oa r ame t e rs  entry; 

del  yn,answer_ok  entry  (character  (3)  varying); 


dc  I 

(35)); 


he s, S i n i t i a t e, coun t  entry 
fTxed  bin(24) 


(char(*)#  char(*)# 
fixed  bin(2)#  ptr# 


c  h  a  r  (  * ) 
fixed 


del  copy  entry  options  (variable); 
del  get,wdir,  entry  returns  (character  (168)); 
del  c 0 n V er t ,s t a t u s , cod e,  entry  (fixed  bin  (35)#  char  (8) 
gned#  ”  ~ 

char  (100)  aligned); 


bin 

a  I  i 


on  unde f i nedf i I e  (data, file)  f I  a g2 . good, j ob_n ame  =  false; 


working_dir  =  get_wdir_  (); 
flag2. done, init  ~  false; 
do  while  (  done, init  =  false  ); 
good  i ob,ti t  I  e  =  true; 

T  I  aglf.  good  i  Ob  na  rre  =  true; 
put  edit  (Would  you  like  to  : 
put  skip; 


’*)(skip#  a); 


put  edit  ("1,  Access  an  old  job  file")(slfiD/a)«' 

out  edit  ("2.  Create  a  new  job  file  ")(skiD/a); 

put  edit  ("3.  Yccify  an  old  job  file'*)(skip#a); 

put  edit  (”4.  Return  to  Main  Me nu" )  ( s k i p # a  )  ^ 

put  skip; 

put  edit  ("Please  choose  one  of  the  above  =>  '')(skiD/a); 
get  list  ( c  )  ; 
range  =  4; 

call  num_ an s we r _c k  (c/  ranges  choice); 


if  (choice  =  1)  then 
do; 

f I ag 2 - bu i  I  c_m ode  =  false; 

put  edit  ("Enter  the  job  name  =>  ")(skiD/  a); 
get  list  (job_name); 

open  file  (dat affile)  title  ("vfile  "lljob_namell” 

.data") 


n put ; 


i  f 


s  k ip/a)  ; 


k i p/ a )  ; 
p#a)  ; 
ip/a); 

/a)  ; 

") (skip/a)  ; 
sts  =  false  5 


stream  i 

( f  I  ag 2. goo d_ j ob^name  «  true)  then  do; 

call  get  data_fTle  (data.file/  good. j ob_t i 1 1  e) ; 

put  ecit("The  current  status  of  this  job  is:  ")( 

Put  skip; 

if  ( f  I  ag« c on t  ex i s t s  =  true)  then 

put  edit  (  A  continuous  system  exists")(s 

if  ( f  I  ag. d i s c ret e_ex i s t s  =  true)  then 

put  edit  ("  A  discrete  system  exists ")(ski 

if  ( f  I  ac. quant i zed.ex i s ts  =  true)  then 

put  edit  ("  A  quantized  system  exists")(sk 

if  ( f  I  a g, c on t r 0 l.l aw.v a  I i d  =  true)  then 

put  edit  ("  A  control  law  is  valid  ")(skip 

if  ( f  I  ag, s i m  va  I  i d  «  true)  then 

put  edit  ("  A  simulation  of  the  job  exists 

if  ( f  I  ag, c on t_e X i s t s  =  false  8  f I  a g. di sc r e t e.e x i 


f  lag  .  quan t i zed.ex i s t s  =  false  8  flag.contr 
ol.law^valid  =  false  8 

f  I  aq , s i m.v a  I i d  =  false)  then 
put  edit  ("  No  models  or  files  exist  for  th 

is  job”)(skio/3); 

put  skip; 


end; 


end; 

if  (choice  =  2)  then 


do  ; 

put  edit  ("Enter  name  of  the  new  job  file  =>  ")(ski 

p / a)  ; 

?et  list  (job.name); 

I ag2 .bu i  I d.m ode  ®  true; 
call  generate.parameters; 
end; 

if  (choice  =  3)  then 
do; 

put  edit  ("Enter  name  of  job  file  to  be  modified  => 
")(skip/  a); 

get  list  (iob.name); 

put  edit  ("Enter  name  of  new  job  file  =>  ”)(skip/  a 

)  ; 

get  list  ( job.name.new) ; 

open  file  (data.file)  title  ("vfile.  " I  I j ob.n ame M " 
.data")  stream  input;  ~ 

flag  2. build. mode  =  false; 
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if  (  f  I  a  g  2  .  GOO  cl_  j  ob_n  am  e  =  true)  then 
do; 

/***/  call  copy  (job  nameir'.data"^  job  name.newli" 

.data",  "-bf"); 

open  file  (data_file)  title  ("vfile^  "IIjob_n 

a  m  e^  n  e  w 

ir'.data")  stream 

input; 

call  get  data  file  (data_file/  good_job  title 

)  ; 

if  (  con t rol_ I au_va I i d  =  true)  then  do; 

call  h c s_$ i n i t i a t e_c oun t  ( uo r k i ng_d i r ,  job_ 
name  I  I ".control^ law", 

'* '*  ,b  i  t^c  oun  t  ,  0,  c  o n t  r  o  I  _  I  a  w_  f  i  I  e_ p  t  r  / 

code)  ; 

en  d  ; 

job_name  =  j ob_name_new; 
end; 

end; 

if  (  choice  *  4 )  then 

f I  a g2 . don e_ in i t  *  true; 
if  (  f I ag2 . good^ j ob _name  =  false  )  then 
do; 

put  edit<job_name,  ".data  does  not  exist.") (skip, 

a,  a)  ; 

flag2-done_init  =  false; 

end; 

if  (  good  job^title  =  false  )  then 
do; 

f I ag2 .good_job.name  =  false; 
f I ag 2 . done^i n i t  *  false; 
end; 

if  ( f lag2« good. job^name  =  true  i  choice  <  4  )  then 
do  ; 

f i rs t_ i n i t.f I ag  *  false; 
f  I ag 2 « done.i n i t  =  true; 
end; 

end; 

ge ne r at e.p ar ame t e rs  :  procedure; 

del  1  flag  external, 

2  cont^exists  bit(l), 

2  d i sc r e t e.e xi s t s  bit(1), 

2  quan t i 2 e d.ex i St s  bit(1), 

2  cent ro l^  I  aw^v a  I  i d  bit(1), 

2  sim.valic  bTt<1), 

2  own.quan t. f i I e.e X i s t s  bit(l); 

del  title  character  (70)  varying  external; 

del  true  bit(1)  initial  ("1"b); 
acl  false  bit(1)  initial  ("0"b); 
dc  I  sys in  file  input; 
del  sysprint  file  output; 
del  data. file  file; 

del  c han ge.pa r ame t e rs  entry; 


f  I  ag«  c  on  t_e  xi  s  t  s  =  false; 

f  I  agi  d i s c r et e_ ex i s t s  =  false; 

f I ag, qu an t i 2 ed.ex  i  s t s  =  false; 

f I  a g. c on t r 0 1. I  aw. V  a  I  i d  =  false; 

f I ag. s i m.va 1 1 d  =  false; 

f I ag, oun.ouan t _ f i  L e.e X  i  s t s  =  false; 

put  skip; 
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put  edit<”Enter  a  title  for  the  data  file  "  )  (  s  ic  i  a  )  ; 
out  edit  ("Note:  Quotes  are  reaui red  if  more  than  one  word 
is  used")(skio#  a); 
put  skip; 
get  list  (title); 

call  c ha nge.pa r a  me t e r s  ; 

end  gene  rat e_p» r ame t ers ; 

g e t_aa t a. f  i  I  e :  procedure  (data_file^  good_ j ob_ t i 1 1  e ) ; 

del  dat affile  file; 

del  good^ j ob^ t i t I e  bit(1); 

del  job  name  character  (50)  varying  external; 
ocl  title  character  (70)  varying  external; 

del  true  bit(1)  initial  (”1"b); 
del  false  bit(1)  initial  ("0"b); 
del  1  flag  static  external/ 

2  cont_exists  bit(1)/ 

2  di  sc  r  et  e_e  xi  s  t  s  bitd)/ 

2  quan  t  i  2  ed_  ex  i  s  t  s  bitd)/ 

2  c  ont  r  o  I  I  au^v  a  I  i  d  bitd)/ 

2  si valid  bit(1)/ 

2  own^quan  t_f  i  I  e_ex  i  st  s  bitd); 


del  ne X t_ s t at e  f i I e_pt r  pointer  external; 

del  Qwn^qua nt^da t a^ t i t I e  character  (50)  external; 

del  n  fixed  external; 
del  p.real  fixed  external; 
del  p  fixed  external; 

del  a. matrix  (1;n/  1:n)  float  controlled  external; 
del  b_matrix  (1:n/  1:o)  float  controlled  external; 

del  tau  float  ex-ternai; 

del  phi_matrix  (1:n/  1:n)  float  controlled  external; 
del  I ambda^ma t r i X  (1:n/  1:p)  float  controlled  external; 

del  number_of _steps_s  d:n)  fixed  controlled  external; 
del  vo  1 1  age_upper_bound_s  d:n)  float  controlled  external; 
del  VO  1 1 age_ I o wer _bcun q_s  d:n)  float  controlled  external; 

del  number_of ^ s t e D s_i  (1:p)  fixed  controlled  external; 
del  VO  1 1 age_upper_bQun d_i  drp)  float  controlled  external; 
del  VO  1 1 age_l o we r_b cund_ i  (1:p)  float  controlled  external; 

del  num_state_conrbs  fixed  external; 
del  num_ i nput_ comb s  fixed  external; 

del  t he_nex t_ s t a t e  map D i ng  (1 :num^state_combS/  1 :num_i nout_c 
ombs)  fixed  binary  (T8)  ~  “  “ 

unsigned  based  (next_state  file 

-Ptr): 

del  next  state.map  (1:num_state  combs/  1:num  input  combs)  fi 
xed  controlled  external;  ~ 

acl  control_law_file_ptr  pointer  external; 
ocl  cost_function_code  fixed  external; 

del  s t a t e_c os t _ma t r i X  (1:n)  float  controlled  external; 
del  i nput_cos t _ma t r i X  (1:p)  float  controlled  external; 


/*  The  above  variables  are  stored  in  the  same  order  as  decla 
red  * / 
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del  s t i I l^dat a _ I e f t 
del  skiD_amount  fixed; 
del  i  fixed; 
del  j  fixed; 

del  answer  eharaeter  (3)  varying; 
del  sysin  file  input; 

del  e n an ge_pa r ame t e r sS bu 1  I  d_ne X t_ s t a t e_ f i  I  e  entry; 

del  e h a nge_pa r ame t e r s S bu i I d^™ i s e_a r ra y s  entry; 

del  c h ange.pa r ame t e r s Sb u i  ld_e on t _ r eg_ sa t_edg_ a r r y s  entry; 

del  e h ange_pa r ame t e r s  entry; 

del  yn_ansuerok  entry  (character(3)  varying); 
del  sysprint  tile  output; 

del  unde f i ned f i I e  eendition; 
del  uorking_dir  eharaeter  (168)  external; 
del  bit_eount  fixec  bin(24); 
del  eode  fixed  bin(35); 

del  h e s  S i n i t i a t e_ e oun t  entry  (ehar(*)/  ehar(*)#  ehar(*)/  fi 
xedbin(24)# 

fixed  bin(2)^  ptr^  fixed  bin  (35)); 

/★  ★★★★  ★/ 


get  file  (data_file)  edit  ( t  i  1 1  e ) ( s k i p /  a(70)); 

put  edit  ("The  title  of  this  data  file  is:  ")(skip#a); 

put  edit  ( t i t I e  )  < s k i p^ X ( 3 ) ^  a); 

put  edit  ("Is  this  the  correct  file”*  ")(skio/a); 
get  list  (answer); 
call  yn_answer_ok  (answer); 
if  (answer  =  "y ”  I  answer  =  "yes”)  then 
do; 

get  file  (data_file)  edit  ( f I ag. cont_ ex i s t s ) ( s k i o^  b(1 

)  )  ; 

get  file  (data_file)  edit  ( f I ag , d i sc r et e_e x i s t s ) ( s k i p » 

b  ( 1 )  )  ; 

get  file  (data_file)  edit  ( f I ag. ouant i z ed_ ex i st s ) ( s k  i  o 

^  b  ( 1  )  )  ; 

get  file  (data_file>  edit  ( f  I  ag . c on t r o I  law  valid)(ski 
p,  b ( 1 ) ) ; 

get  file  (data_file)  edit  (  f  I  ag. s i m_v a  I i d ) ( s k i p #  b(1)) 

# 

get  file  (data^file)  edit  ( f I ag , o wn_au an t_ f i  I  e«e x i s t s  ) 
(skip#  b(1)); 


if  ( f I ag. cont _ ex i s t s  =  true  I f I ag. d i sc r e t e_e x i s t s 
quan t i z ed_e X i s t s  =  true  I  f  lag. cont ro l_ I aw_va I i d  = 
tn  valid  =  t  rue )  then 
3o; 


get  file  (data_file) 
get  f-ile  (data_file) 
if  (p_real  =  0)  ther 
p  =  In¬ 
cise 


edit 

edit 


(n) (skip#f(5)  ) 
(p_real) (skip# 


f  (  5  )  )  ; 


p  =  o_r eal  ; 
end; 


=  truelflag 
true  I flag.s 


if  ( f I ag. cont_ ex i s t s  =  true)  then 
do ; 

allocate  a^matrix; 
allocate  b_rratrix; 
do  i  =  1  to  n; 

doj  =1  ten; 
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get  file  (data  file)  edit  {a_matri)(  (i#j))(skip# 

fa  2,  4  )  )  ; 

end; 

end; 

do  i  =1  ton; 
doj  =1t00' 

get  file  (data_file)  edit  (b^matrix  (i^j))(skio# 

fa  2,  4 ) )  ; 

end; 
end; 
end  ; 


if  ( f I ag, di sc r e t e  exists  =  true)  then 
do; 

allocate  ohi^iratrix#  lambda_(T»atrix; 
get  file  (data^file)  edit  (tau)(skip/  f(12/  4)); 
do  i  =  1  to  n; 
doj  =1  ten; 

get  file  (data  file)  edit  (ohi.matrix  (i^  j))(sk 

io-r  fa2,  4)); 

end; 

end; 

do  i  =  1  to  n; 
do  j  =1  to  p; 

get  file  (data_file)  edit  (lambda  matrix  (i/  j)) 
(skip^  f(12^  4)); 

end; 

end; 

end; 


if  ( f I  a g, Quan t i 2 ed.ex i s t s  =  true  I  f I ag. own_qua n t_ f i I e.e x i s t 
s  =  t  rue )  then 
do; 

allocate  nu mber^o f^s t eps_s/  vol tage^uppe rebound. s^  vol 
tag e_ lower _bound_s; 

allocate  number.of^steps.i ^  vo I t age.uppe r_bound_ i r  vol 
tage_lower_bound_i; 


doi=1  ton; 

get  file  (cata^file) 

kip,  f(5)); 

end; 

do  i  =  1  to  r; 

get  file  (  da  t  a  f i I e ) 
f  vo I t age^ lower^bounc^s ( i T) 

(skip# 

end; 

do  i  =  1  to  p; 

get  file  (cata_file) 

kip#  f(5)); 

end; 

do  i  =  1  to  p; 

get  file  (data  file) 
)#  VO  1 1 age^ I  owe r _bo unc_i  Ti)) 

2  #  4  )  )  ; 


edit  (number^of ^st eps_s  (i))(s 


edit  (vol tage_upoer_bound_s ( i  ) 
f  (12#  4)#  x(3)#  f  (12#  4)); 

edit  (number_of_st eps_i  (i))(s 

edit  (vo 1 1 age_upper_bound_  i  (i 
(skip#  f (12#  4)#  x(3)  #  f  (1 


end; 


call  change_parametersSbui ld_mi sc^arrays; 


if  ( f I ag. own  quan t  f i I e_ex i St s  =  true)  then  do; 

get  file  Tdata_file)  edit  (own_ouant_data  title)(skip#  a( 

7  0)); 

call  hes  Sinitiate  count  ( work i ng_di r #  own  qu an t^d a t a_ t i t 
le#  -  -  - 

’"*  #  bit_count#  0#  next_st  ate_f  i  le_ot  r#  c 

ode) ; 
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allocate  ne  x  t_  s  t  ate_niap; 
do  i  =1  to  nu  (r_  s  t  a  t  e_c  omb  s  ; 
do  i=  1  to  nurr_input_combs; 

ne X t_ s t a t e_ma p  (i^j)  =  t h e_n e x t_ s t a t e  napo i nq ( i  /  j ) ; 

end; 
end; 
eno; 

else  do ; 

call  change^parairetersSbuild  next  state  file; 
end; 


call  change_parametersSbui ld_cont_reg_sat_edg_arrys; 
end  ; 


i  f 

".control, 
de)  ; 


( f I  a g . c on t ro I  law  valid  = 
do; 

call  hcs  ^initiate  count 
law"/  ""/ 

bit.count/  0/ 


true)  then 

( wo r k i nq_ d i r /  job.namell 
c on t ro I _ I  a w. f i I e.p t r /  co 


,  ■  <data.file)  edit  ( cost,  func  t  i  on  code)  (s 

k 1 p/  f ( 5  )  )  ; 

if  (cost.funct ion  code  =  2)  then 
do; 

allocate  s t a t e.cos t _ma t r i x ; 
do  i  =1  to  n; 

,  -  (data.file)  edit  (state.cost  ma 

tnx  (i))<skip/  f<12/4)); 

end; 
en  c  ; 

_  ,  ^  i  i'  (cost.f  uncti  on.code  =  2  I  c  o  s  t .  f  unc  t  i  on  code 

=  3  )  then 

do; 


matrix 


(i))(skip/ 


allocate  input.cost. matrix; 
do  i  =  1  to  p; 

get  file  tdata.file)  edit 
f (12/4)); 

end; 

end; 


( i  nput.c  ost. 


end; 

end  ; 
else 

good. j ob.t i t I e  =  false; 
close  file  (data.file); 
end  g  et.data. f i  I  e ; 
end  i n i t ; 
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c h ang e^pa r ame te p s :  procedure; 


del  job  name  character  (50)  varying  external; 
ocl  worJcing_dir  character  (163)  external; 
del  ne X t_s t at e_ f i  I e_pt r  pointer  external; 

del  n  fixed  external; 
del  0  fixed  external; 
del  o_real  fixed  external; 

del  number. of_stecs_s  (1;n)  fixed  controlled  external; 
del  numb e r.of _ s t e c s_ i  (1:p)  fixed  controlled  external; 

del  VO  1 1 age.upper.bound.s  (1:n)  float  controlled  external 
del  VO  1 1 age.l ower.bcund.s  (1:n)  float  controlled  external 
del  VO L t age_upper_bcund_ i  dip)  float  eontrolled  external 
del  voltage.lovier. bound. i  (1:p)  float  controlled  external 
del  a_matrix  (1:n/  Itn)  float  controlled  external; 
del  b_ matrix  (1:n^  1:p)  float  controlled  external; 
del  tau  float  external; 

del  phi  matrix  (1:n^  1;n)  float  controlled  external; 
del  lambda. mat ri X  (1;n/  1 :p)  float  controlled  external; 
del  offset. s  (1:n)  fixed  controlled  external; 
del  offset. i  (1:p)  f i x ed  cont ro t I ed  external; 
del  num.state.combs  fixed  external; 
del  num.i nput^combs  fixed  external; 

del  quantum. step_ size. s  (1:n)  float  controlled  external; 
del  quan t um.s t ep^ s  i  ze.  i  <1:p)  float  controlled  external; 
del  num. contr o 1 1  a b  I  e_c e  1 1  s  fixed  external; 
del  uncontrol  I  ab  I  e.ce  t  I  (1  ;  num.s  t  a  t  e^  co  mbs  )  bitd)  controlle 
d  external; 

del  sat. edge  ( 1  ;  num.st  ate..combs^  1:num. input  combs)  bitd)  c 
ontrolled 

external; 

del  the_next. state  trapping  (1  :num.,state_combsr  1  rnum.i  nput.c 
ombs)  fixed  binary  (18) 

unsigned  based  ( nex t_s t a t e. f i I e .p t r )  ; 
del  next  state. map  11 : num.st at e.combs #  1  :num. i nput. combs  )  fi 
xed  controlled  external; 

ocl  title  character  (70  varying  external; 

del  own.quant.da t a. t i t I e  character  (70)  external; 

del  bit. count  fixed  bin(24); 
del  code  fixed  bin(35); 

del  i  fixed; 
del  j  f  i  xed; 

del  answer  character  (3)  varying; 

del  c  character  (1); 

del  choice  fixed; 

del  c2  character(l); 

dc I  Choi ce2  fixed; 

del  c3  charaeter  (1); 

del  choice3  fixed; 

del  range  fixed; 

del  col. min  fixed; 

dc I  CO l.max  f i xed  ; 


del  true  bitd)  initial  C'Vb); 
del  false  bitd)  initial  (''Q''b); 
del  1  flag  externals 

2  cont. exists  bitd)/ 

2  di  sc  r  ete.exi  s  t  s  bitd)/ 

2  quan t i z e c. ex i s t s  bit(1)/ 

2  c ont r 0 1. I  a w.v a  I  i d  bit(1)/ 
2  si m. valid  bit(l)/ 
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2  oun_quan t _ f i I e_?x i St s  bitCI); 

del  1  f I ag  2^ 

2  changed_n  fcitd)# 

2  need  set  bit(1)x 
2  modi  T y_d i s c re t e  bit(1)/ 

2  f i le_ no t _e X i s t  bit  (1); 


del  da  t  a_f i le  f i I e  J 

del  sysin  file  incuts 

del  sysprint  file  output; 


del  eon ver t _S e on t _ s t a t e_ t o_d i s_ s t a t e  entry  ((*)  float# 
i  X  e  d )  ; 

del  eonvert  Sdis  state  to  eode  entry  entry  ((*)  fixed# 

)  ; 


del  eonvert_$eode_to_dis_state  entry  (fixed#  (*)fixed); 
del  eonw er t d i s_ s t at e _t o^eon t _s t a t e  entry  ((*)  fixed# 

I  0  at )  ; 

del  eon ver t _$ e ode^ t o_d i s^i npu t  entry  (fixed#  (*)  fixed) 
del  eonver t_Sd i s_ 1 nput _to_eont_i nput  entry  ((*)  fixed# 

I  0  at )  ; 

del  num.answe r_ok  entry  (eharaeter  (1)#  fixed#  fixed); 
del  yn^answer_ok  entry  (eharaeter  (3)  varying); 
del  prTnt_nex t_st ate_f i le  entry; 


( *)  f 
fixed 

( ★)  f 

(  *)  f 


del  he s  S i n i t i a t e_ e cun t  entry  (ehar(*)#  ehar(*)#  ehar(*)#  fi 
xed  bin  (24)# 

fixed  bin  (2)#  otr#  fixed  bi 

n  (35)); 

del  he s_ Sflia ke_ seg  entry  (ehar(*)#  ehar(*)#  ehar(*)#  fixed  bi 
n  (5)# 

ptr#  fixed  bin(35)); 
del  delete  entry  options  (variable); 
del  eopy  entry  options  (variable); 


del  null  bu i I t i n# 


FARMS:  put  skip; 

flag2. modify  ciserete  =  false; 
put  edit  ("wTiich  of  the  following  would  you 
di  fy/ereate-»") 

a)  ; 


like  to  mo 
(skip# 


put  skip; 
put  edit  (”1 
put  edit  ("2 
put  edi t  ( “3 
put  edit  ( ” 4 
put  edit  ("5 
put  skip; 
put  edit  (" 


.  Title  of  the  job  file")(skio#  a); 

.  Continuous  system  pa r a  me t e r s" ) ( s k i p 
.  Discrete  system  pa r ame t e r s" ) ( s k i o # 

.  Quantized  system  pa rame t e r s ") ( sk i p# 
.  None  of  the  above‘s' )(  sk  i  p#  a); 

Please  choose  one  =>  ")(skiD#a); 


#  a ) 
a)  ; 
a ) 


get  list  (c); 
range  =  5; 

call  num_answer_ok  (c#  range#  choice)? 
flag2.need_set  =  false; 

gotocase(choice); 

case(1):  put  skip; 

put  edit  ("Enter  a  file  title  ”)(skio#  a)? 
out  edit  ("Note:  Quotes  are  reouired  if  more  than  o 
ne  word.")(skip#a); 

put  skip; 
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c  a  s  e  (  2 ) 


get  list  (title) 
goto  P.ARNiS; 


k i 0^  a )  ; 


put  skip; 

if  (flag, ccnt_ exists  =  true)  then 

do ; 

out  ecit  ("Which  parameter(s)  would  you  like 

to  change'’")  (s 


put  edit  ("1. 
put  eait  ("2. 
put  edit  ("3. 
put  ecit  ("4. 
put  ecit  ("5. 
put  edit  ( "6. 
put  skip; 
out  eait  ("Please 
get  list  (c2); 
range  =  6; 

call  num^ansuer^ok  (c2>  range#  choice2); 


Number  of  states ")(skiD#a); 
Number  of  i  npu t s " ) ( s k i p# a ) ; 
System  matrix#  A")(skio#a); 
Input  matrix#  0")(skio#a); 
All  of  the  above ")(skip#a); 
None  of  the  abov e" ) ( s k i o # a ) 


choose  one  =>  ")(skio#a) 


if  (choice2  6)  then 
flag2-need  set  =  true; 
goto  ca s e_2 ( c ho i ce2 ) ; 
end; 
else 
do ; 

f l ag . con t  ex i St s  =  true; 
f I ag2 .need_set  =  true; 
chorce2  = 

allocate  a  matrix#  b^matrix; 
goto  case_2(1); 
end ; 


cas  e_2  ( 1 ) ; 


a); 


out  skip; 

put  edit  ("Enter  number  of  states  s>  ")(skip# 


get  list  (n); 
if  (choice2  *=  5)  then 
do; 

if  ( f  lagZ.modi f y_di sc rete  =  true)  then 

put  edit  ("The  discrete  system  and  inpu 
t  matricies  must  now  be  mod  i  f i ed :") ( s k i p# a ) ; 

else 

put  editC'The  system  matrix#  A#  and  inp 
ut  matrix#  B#  must  now  be  modi f i ed: " ) ( s k  i  p#a )  ; 

flag2. changed  n  =  true; 
goto  case, 2(37; 
end; 
e  I  s  e 

goto  case, 2(2); 


case_2<2):  put  skip; 

put  edit  ("Enter  number  of  inputs  =>  ")(skio# 

a )  # 

get  list  (p,real); 
if  (o,real  >  0)  then 
0  =  o_reai; 
else 

p  =  i; 

if  (choice2  “=  5  )  then 
go; 

if  ( f I ag2 .mod i f y, di s c re t e  =  true)  then 
put  edit  ("The  discrete  input  matri 
X  must  now  be  modi f i ed: " ) ( sk i o#  a); 

else 

put  editC'The  input  matrix#  B#  must 
now  be  modified:") (skip#  a); 
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goto  case_2(4); 


end ; 
else 

goto  case_2(3)/' 

case_2(3):  out  skic;  v  ^  • 

if  ( f I  a g 2 . mod i f y 1 s c r e t e  =  true)  then  do» 
free  ohi^matrTx; 
allocate  phi^matrix; 

cut  edit  ("Enter  values  for  the  discrete  s 
ystem  matrix#  ohi")(skiD#a); 

end; 

else  do ; 

freeamatrix; 

put  edTt  ("Enter  values  for  the  4  matrix”) 

(skip#  a ) ; 

allocate  a.matrix, 
end  ; 

put  skip; 
do  1  *  1  to  n; 

dci=1ton; 

if  ( M ag 2 . mod i f y_d 1 s c r e t e  =  true)  then 

put  edit  ("phi  (”#  i#  ”#  "#  j#  ”)  => 
")  (x(3)#  a#  f  (3)#  a#  f <3)#  a);  . 

get  list  (phi  matrix(i#  j))» 
end; 

else  do# 

put  edit  ("A  ("#  i#  "#  "#  j#  ")  => 

)  (x(3)#  a#  f (3)  #  a#  f  (3)#  a>;  .  ,  . 

get  list  (a_matrix(i#  j))» 
end; 
end; 
end  ; 

if  (choice2  *=  5  )  then  do; 

if  ( f  lag2«changed.n  *  true)  then 
do; 

flag2,chanaed  n  *  false; 
goto  case^2(47; 
end? 

else  do;  ,  .  ^  . 

if  ( f  I  ag 2 . mod  1 f y^d 1  sc r et e  =  true)  then 
goto  Modify_dis; 
else 

goto  case(2); 

end; 

end; 

else 

goto  case_2(4); 

case_2(4):  put  skip; 

if  (  p^real  >  0  )  then 

if  < f  I  ag 2 . mod  1 f y  discrete  =  true)  then 
do; 

free  I ambd a_ ma t r i x ; 
allocate  I ambda_ma t r i x ; 
put  edit  ("Enter  values  for  the  d 
iscrete  input  matrix#  lambda ”)(skio#a); 

end; 

else 

do; 

free  b^matrix; 
allocate  bmatrix; 

put  edit  (Enter  values  for  the  3 

matrix ”)(skip#  a); 

end; 

put  skip; 
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then  do^ 
j,  ••)  =>  ”5 


)  =>  ")(x(4)^  a. 


do  i  =  1  to  n; 

d  0  j  =1  top; 

if  ( f  I  a g 2- mod  1 f y_d i s c re t e  *  true) 

put  edit  C”  lambda  (’’/  i#  *'/ 

(x(4)/  a/  f(3)^  a,  f(3)/  a); 
get  list  < I  am bd a _ma t r  i  X <  i  /  j)) 

end; 

else  do; 

put  edit  ("8  i,  " ,  " ,  j,  ” 

f(3)/  a,  f (5),  a); 

get  list  (b_matrix(i/  j)); 
end; 
end; 
end; 
end; 
else 
do; 

free  b_mat  r i x ; 
allocate  b_matrix; 
b_mat  ri X  =  O; 
end; 

if  ( f I  a g 2« modi f y^d i sc r e t e  =  true)  then 
gcto  Modify.dTs; 
else 

gcto  case<2); 


case_2<5):  goto  case_2<1); 


case^2<6) : 


if  (f  I  ag2«need_,set  *  true)  then 
do; 

f l ag. cont_ex i St s  =  true; 
flag. discrete^. exists  »  false; 
f I ag. Quan t i zed.ex i s t s  =  false; 
f I ag. cont ro l^l aw.va  I  i d  *  false; 
f I ag. s i m_va 1 1 d  *  false; 
end; 

goto  farms; 


case(3):  /*  Discrete  Farms  */ 

put  skip; 

f I ag2 - mod i f y_d i sc rete  =  true; 
if  (f I ag. con t_ e X i s t s  =  true)  then 
do; 

put  ecitC'A  continuous  model  exists^  would  you 
like  to:  ")(skip»a); 

put  skip; 

put  eait<"1.  Generate  a  discrete  model  from  t 
he  continuous  s y s t e m" )< s k i p /  a); 

if  ( f lag . d i sc r e t e_e X i s t s  =  true)  then 

put  edit  (”2.  Modify  your  existing  discret 

e  system")(skio^a); 

else 

put  edit(”2.  Enter  a  new  discrete  system") 

( s  k i p^a )  ; 


put  e€it("3.  Quit")(skip/^a); 
put  skip; 

put  ecit("Flease  choose  one  =>  ")(skio^a); 

getlist(c2); 

range  =  3; 

call  num_answer_ok  (c2#  range#  choice2); 


if  (choice2  =  1)  then  do; 

f lag. d i sc rete.ex i s t s  =  true; 
f I ag. ouan t i z ed_e X i s t s  =  false; 
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flag. control, Law_valid  =  false; 
f I aq . s i m, V  a  I Td  =  false; 
if  I f I ag, d i s c r e t e_ex 1 s t s  =  true)  then 
free  phi_matrix/  I ambda_ma t r  i  x ; 
call  build~discrete,matricies; 
chcice2=3; 


end 
i  f 


end 
i  f 

end; 

else 
do ; 

put 

would  you  like  to") 


t“)(skip#a); 


put 


» 

(choice?  =  2)  then  do; 

tau  =  0.0; 

goto  Mod i f y_d  i  s  ; 

9 

(choice?  =  3)  then 
goto  PARMS; 


ecitC'A  continuous  system  does  not  exist# 

(skip#a); 

ecit  ("1.  Create  a  continuous  system  firs 


if  < f I ag .d i sc  re t e_e X i s t s  =  true)  then 

put  edit  ("?.  Modify  the  existing  discrete 

system") ( s k i o#  a ) ; 

else 

put  eoit  ("?,  Enter  a  new  discrete  system" 

}  ( sk i p# a)  ; 


put  ecit  ("3.  Qu i t " ) ( s k i D# a ) ; 

put  skip; 

get  list  (c2); 

range  =  3; 

call  num,answer_ok  (c?#  range#  choice?); 


if  (choice?  =  1)  then  do#' 

f I ag? . mod  i  f y  di s c ret e  =  false; 
goto  case<2) 7 
end ; 


if  (choice?  =  ?)  then  do; 
tau  •  0.0; 
goto  Modi f y,d i s ! 
enp; 

if  (choi ce?  =  3)  then 
goto  farms; 

end  ; 

Modify_dis:  if  ( f I ag, di s c r e t e  exists  =  true)  then 

do; 


put 

edit  ("Which  of  the 

following  uou 

Id  you  like 

to  modify?)(skip#a); 

put 

put 

skip; 
edi t  ("1  . 

Number  of 

states") (skip 

#a>; 

#  a ) ; 

put 

edi t ("?. 

Number  of 

inputs") (skip 

out 

edi r ("3. 

Discrete 

system  matrix" 

) ( s  k i p#a )  ; 

put 

edi t ("4. 

Pi screte 

input  matrix") 

(skip#a); 

out 

edi t ("5. 

All  of  the  above  )(skiD 

#  a ) ; 

put 

edi t ("6, 

None  of  the  above")  (ski 

p#  a)  ; 

put 

s  k  i  0  ; 

i  p#a ) ; 

put 

edit  (  ®lease  choose  one  =>  )(sk 

get 

list  (c3) 

9 

range  =  6; 
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3)  ; 


u  e  ; 
a  I  se ' 
false; 


call  num^an sue r^o k  (c3/  ranges  choice 


if  (choice3  “=  6)  then 
do; 

f I aq 2 . need, se t  =  true; 
choice2  =  choice3; 
goto  c as e_ 2 ( ch 0 i c e 2  )  ; 
end; 
else 
do; 

if  (flag2.need  set  =  true)  then 
do; 

f I ag . d i s c re t e,e X i s t s  =  tr 

f I ag* quan t i z ed_ e X i s t s  =  f 

f I ag« con t ro I, I aw,va I i d  = 

f I ag . s i m, va I i d  =  false; 
end ; 

goto  PARMS; 

end  ; 
end; 
else 
do ; 

allocate  Dhi_matrix/  L ambda,mat r  i  x  ; 

f  lag2.need,.set  =  true; 

f I ag . d i sc r et e_ e X i s t s  =  true; 

choi ce2  =  5; 

goto  case,2( 1 >  ; 

end; 


case<4);  /*  Quantizec  Parms  */ 
put  skip; 

f  laq.oun,.auant,f i  le.exists  *  false; 
if  ff lag, quant  1 zed„ex i sts  =  true)  then 
do; 

put  edit  ("A  quantized  system  currently  exists 

*• )  <  s  k  i  p  ^  a  )  ; 

put  edit  ("Do  you  still  wish  to  modify  the  qua 
ntized  system?  =>  '')<skip#a); 

get  list  <  ansue  r ) ; 

call  yn_  answer,.ok  (answer); 

if  (answer  =  ”n”l  answer  =  "no”)  then 

goto  parms; 

end  ; 

if  ( f I ag. d i sc r et e_ex i s t s  =  true)  then 
do; 

put  edit(”Would  you  like  to  generate  a  quantiz 
ed  sy s t em" ) < s k i p #a  )  ; 

put  editC”  from  the  discrete  system'’ 

=>  ")(skip#a); 

get  list  (answer) ; 
call  yn, answer, ok  (answer); 
if  (answer  =  ”y”l  answer  =  "yes")  then 
do ; 

if  ( f lag. quant i zed  exists  =  true)  then 
do; 


s  teps_i  ; 

e_upper_bound_s; 
e,upper_bound,i ; 


free  ne x t,s t a t e_map ; 

free  number,©  f_s-t  eps  ,  s  ^  number, of, 

free  vo 1 1 age, I  owe r,b ound, s^  voltag 

free  vo  1 1  age,  I  owe  r,b  ou  nd_  i  voltag 

free  offset, s^  offset, i#  quantum, s 


C-23 


teo^size.s#  qua n t um_ s t eo _s i 2 e_ i  ; 

free  sat_edge/  uncon t ro L L ab I e_ce I  I 

end; 

allocate  number_of_steDS_s; 

out  edit  ("Enter  the  number  of  auantizat 

ion  steps ")Cskip/a); 

out  skip; 
do  i  =1  to  n; 

put  edit  ("for  state  number"#  i#  "  => 

")(x(3)#  a#  f(5)#  a); 

qet  list  ( numbe r_o f « s t e D s^s  (i)); 
end; 

allocate  vo I t age^upper  bou nd_s ^ vo I t age  I 

ouer_bound_s; 

out  edit  ("Enter  the  upoer  and  lower  vol 
tage  bounds  (u#  l)")(skip#  a); 

put  skip; 

do  i  *  1  to  n; 

put  edit  ("for  state  number"#  i#  "  => 

")(x(3)#  a#  f(5)#  a); 

get  list  ( vo I t age_uppe r _bound_ s  (i)# 
vo 1 1 age_ I  owe r_bound_ s  (i)); 

end; 

allocate  number_o f_steos_i  ; 
if  (  p  real  >  0  )  then 
do; 

put  edit  ("Enter  the  number  of  qua 

ntization  steps ")(skip#a); 

put  skip; 
do  i  =  1  to  p; 

put  edit  ("for  input  number"#  i 

#  "  =>  ") (x(3)#  a#  f  (5)#  a); 

get  list  ( numbe r _o f _ s t eos _ i  (i) 

) ; 

end  ; 
end; 
else 

number^o f _s t ep s_ i  (1)  *  I; 


I  owe  r_bound^ i ; 


e  r  voltage  bounds 


=>  ") (x<3)#  a# 


allocate  vo I t age^upoe r_bound_ i #  voltage. 

if  (  p.real  >  0  )  then 
do; 

out  edit  ("Enter  the  upper  and  low 
(u#  l)")(skip^  a); 

put  skip; 
do  i  =  1  to  p; 

out  edit  ("for  innut  number"#  i 

f(5)#  a); 


get  list  ( vo I t age _uDp e r.b oun d_ i 
(i)#  VO  1 1 age.l o we r _b cund_ i  (i)); 

end  ; 


end  ; 
else 
do; 

VO  I t a ge.uDP e r _bou nd_ i  (1)  =  O; 
VO  1 1 age”  I  ow e r ~ bou nd~  i  (1)  =  O; 
end  ; 


put  edit  ("Would  you  like  the  next  state 

filebuilt")(skip#a); 

get  list  (answer) ; 

if  (answer  =  "y"  I  answer  =  "yes")  then 

do; 

call  bui  I  d..mi  sc.ar  rays  ; 

call  h c s_ S 1 n i t i a t e.c oun t  (uorking_dir 
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rf  t« 


.counts 


"-bf”) ; 
name  I  I 

e_  f i  I  e_p  t  r  ^  code); 


)ob_namell".next^state"/  bit 

0^  ne X t _s t a t e_f i t e_D t r #  code); 
call  delete  ( j ob_na me M " . ne x t_ s t a t e " / 

call  he  s_'?ma  ke.s  eq  (  wo  r  k  i  ng_d  i  r  /  job_ 

".next_state”/  "'*/  01010b#  next_stat 


call  bui I d_ next, state. file; 
end; 
end; 
else 
do ; 

put  edit  (*'0o  you  have  a  data  file  conta 
ining  the  qu  ant  i  z  ed '* )  (  s  k  i  p  #  a  )  ; 

out  edit  (**  system  that  you  would 

like  to  access?  =>  ")(skio#a); 

get  list  (answer) ; 
call  yn.answer.ok  (answer); 
if  (answer  =  '’y'*  I  answer  =  "yes”)  then 
f I ag.own.quant.f i  le_ex i St s  =  true; 
else 

goto  PARWS; 

end; 

end  ; 
else 
do; 

put  edit  ("A  discrete  system  does  not  exist,”) 


(  s  k  i  p  #  a )  ; 

) (skip#a); 


put  edit  (“Would  you  like  to  create  one?  => 


get  list  (answer); 
call  yn.answer.ok  (answer); 
if  (answer  s  "y”  |  answer  s  "yes")  then 
geto  PAR!«ts; 

put  edit  (”0o  you  have  a  quantized  system  dat. 
file  that  you  would  tike  to  access?  =>  ">(skio#a); 
get  list  (answer); 
call  yn.answer^ok  (answer); 
if  (answer  =  ”y”  I  answer  =  "yes")  then 
f  I  ag, own^ouant.f i  I  e_ex i St s  =  true; 
else 

goto  P^RMS; 

end  ; 


if  ( f I ag . own.q uan t ,f i I e_ex i St s  =  true)  then 
do; 


if  ( f  I  ag. cuant i zed.ex  i  St s  =  true)  then 
do; 

free  number.of, steps ,s#  number.o f_s t eps_ i 
free  vo ltage_lower_bound,s#  vol tage, upper 

.bound^s ; 

free  vo I t age_ I o wer _b ound, i #  vol t aqe.uooer 

_  bound, i ; 

free  offset_s#  offset_i#  qu a n t u m_ s t ep_ s i z 
e_s#  quan t urn, st e p_ s i ze_ i ; 

free  sat.edge#  uncontrollable, cell; 
free  next, state, map; 
e  n  c  ; 

put  eoit  ("Enter  the  name  of  the  file  to  be  re 
ad  in  =>  ”)(skip#  a); 

/***/  get  list  ( own_quant,dat a, t i t I e) ; 

call  he s i n i t i a t e,c oun t  (wor k i ng.di r# 

cun,quant,data,t i t I e#  ””#  bit, count#  0#  ne 

xt, state, fi le.ptr# 
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le#  "does 


D, 


code); 

if  ( rex t _ s t a t e_ f i L e_D t r  =  null)  then 
dc; 

out  edit  ("The  file"/  own  ouant  data  tit 
not  e K i s t  ) ( s k i 0/ a ) ;  “  “  ” 

out  edit  ("Try  Again  =>  ")(skio/a); 
get  list  ( g wn_ qua n t_da t a_ t i t I e ) ; 
call  hcs_Sinitiate_count~  (working  dir/ 
own_auant_da ta^t  i  t  le  /  ""/  bit_count/ 

next_state_file_Dtr/  code); 
if  ( ne X t_ s t a t e_ f i I e_p t r  =  null)  then 
goto  PARMS; 

end; 


put  edit(”The  following  information  is  need 
ed  to  supplirnent  the  cuantization  model:  ")(skip/a); 

put  skip; 

put  edit  ("the  number  of  states  =>  ")(skip/ 


get  list  (n); 

put  edit  ("the  number  of  inputs  =>  ")(skip/ 


ion  steps" ) (ski  P/a ) 


")<x(3>/  a/  f<5)/ 


get  list  (p_rea I ) ; 
i  t  (p^rea  I  >  0)  then 
p  =  p^reai; 
else 

p  =  i; 

allocate  number^of  steos_s; 

put  edit  ("Enter  tFe  number  of  ouantizat 

0 

out  skip; 

do  i  =1  to  n; 

put  edit  ("for  state  number"/  "  => 

a }  ; 


ower_bound_s; 
tage  bounds  (u/  D” 

"5(x(3)/  a/  f(5)/ 
voltage_lower_bound 


get  list  ( number_of_st eos_s  (i)); 
end; 

al locate  voltage. upoer_bound_S/voltage_l 

out  edit  ("Enter  the  upper  and  lower  vol 
)(skip/  a); 
put  skip; 
do  i  =  1  to  n; 

out  edit  ("for  state  number"/  i/  "  => 

a  ) ; 

get  list  ( VO  1 1 age.uppe r  bound  s  (i)/ 

.  s  ( 1 )  J ; 


end; 

allocate  number.of  steos  i; 
if  (  p.real  >  0~ )  then 
do; 

put  edit  ("Enter  the  number  of  oua 

ntization  s t eps " ) ( s k  i  o/ a  )  ; 

put  skip; 
do  i  *  1  to  p; 

„  ^  edit  ("for  inout  number"/  i 

/"=>")(x(3)/a/f(5)/a); 

get  list  ( numb e r _ 0 f _ s t ep s _ i  (i) 

^  0  * 

end  ; 
end; 
else 

number_of .steps  i  (1)  =  i; 


,  .  ..  allocate  vo  1 1 age.upoer  bound  i/  voltage 

louer_bound.i  ;  -  - 

if  (  p.real  >  Q  )  then 
do; 
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put  edit  ("Enter  the  upper  and  Low 
er  voltage  bounds  (u#  L)")(skio#  a); 

out  skip/ 

do  i  =  1  to  0^ 

put  edit  ("for  input  number"/  i 

/  "  =>  ") (x(3)/  a/  f (5) /  a) ; 

get  list  ( VO L t ag e_uoo e r^bou nd_  1 
(i)/  voltage  I o we r _b cun d_ i  (i)); 

end; 

end; 

else 

do;  . 

vo l t age_uoo e r_bound_ 1  (1)  =  O; 

voltage^ lower_bound_i  (1)  =  O; 
end;  ” 

call  bu i I d_m i s c_a r r ay s ; 


allocate  nex t_ s t a t e_mao ; 
do  i  =  1  to  num_s t a t e_ c omb s ; 

do  i  =  1  to  num_ i npu t_ c omb s ; 

nex t _s t a t e.map  (i/j)  =  the_next_st 

ate  mapping  (i/j); 

end  ; 
end; 

end  ; 

call  bui I d_con t_reg_sat^edq_a prys; 
call  p ri nt_nex t_state_f 1  le/ 

f I ag. ouan t  i  zed^e X i s t s  =  true; 
f I ag« c on t ro l^l aw_va I i d  =  false; 
flag. si m^ valid  *  false; 

goto  PARMS; 


case(5):  /*Qui t*/ 

put  skip; 


buiLd_discpete_matricies;  procedure; 

del  n  fixed  external; 
del  p  fixed  external; 

del  tau  float  external; 

del  phi  matrix  (1:n/  1;n)  float  cont r o I  1 ed  ex t e rna  I  ; 
del  lambda  matrix  (1:n/  1:p)  float  controlled  external/ 


del  j  f i xed; .  ^  ^  . 

del  matrix_dim  fixed  binary  (35)/ 

del  ind  fixed  binary  (35); 

del  ier  fixed  binary  (35); 

del  time  float  binary; 

del  time  end  float  binary; 

del  tol  7loat  binary; 

del  c  (1:24)  float  binary; 

del  cont_state  (1C)  float  binary; 

del  cont  input  (1:o)  float  binary  controlled  external/ 

del  w  (iTn/  1:9)  flcat  binary  controlled; 

del  temp^prime  (1:r)  float  controlled  external; 

del  imslSdverk  entry  (fixed  binary  (35)/  entry/  float  binary 
/  (* )  float 
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xea  binary  (35)^ 
*)  float 


binary/  float  binary/  float  binary/  fi 
(*)  float  binary/  fixed  binary  (35)/  ( 
binary/  fixed  binary  (35)); 


del  sysin  file  inoLt; 
del  sysorint  file  cutput; 

allocate  cont.inout/  temo^prime/  w/  p  h  i  _fiiat  r  i  x  /  I  ambda_mat  r  i 


put  edit  ("Enter  tati  =>")  (  sk  i  p/ x  (  4  ) /a  )  ; 
get  list  (tau); 
do  i  =  1  to  n; 
cont.state  =  O; 
con  testate  (i)  =  i; 
irat  r  1  x_di  m  =  n; 
time  =  0 ; 
t i me_end  =  tau; 
tol  =  .0001; 
i nd  =  1 ; 

call  imslSdverk  (mat r i x^di m/  eauation_a/  time/  cont_state/ 
t i me_end /  “  ~ 

tol/  ind/  c/  matrix_dim/  w/  ier); 

do  i  *  1  to  n; 

pni_matrix  (j/  i)  =  cont_state  (j); 
end; 
end  ; 

do  i  =  1  to  p; 
cont. state  =  O; 
cont.input  *  0; 
cont, i nput  ( i )  =  i; 
matrix.dim  *  n; 
time  s  0 ; 
time_end  =  tau; 
tol  =  .0001; 
ind  =  1 ; 

call  imslSdverk  ( tra  t  r  i  x_d  i  m  /  equation_b/  time/  cont_state/ 
t  ime^end/  ” 

tol/  ind/  C/  matrix_dim/  w/  ier); 

do  j  s  1  to  n; 

lambda  matrix  (i/  i)  =  cont  state  (j); 
end; 
en  d ; 

put  edit  ("PHI  MATRIX  =  ")(skip(2)/  a); 
do  i  =  1  to  n; 
put  skip; 
do  j  =  1  to  n; 

put  list  (phi^matrix  (i/  j)>; 
end; 
end; 

put  edit  ("LAMBDA  MATRIX  =  ")(skip(2)/  a); 
do  i  =  1  to  n; 
put  skip; 
do  j  =  1  to  p ; 

out  list  (lambda  matrix  (i/  j)); 
end; 
end; 

free  cont_inDut/  te(rp_prime/  u! 


equation  a:  procedure  (matrix_dim/  time/  cont_state/  cont_st 
ate_prime)T 
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del  matrix^dim  fixed  binary  (35); 

del  time  float  binary; 

del  eont.state  (1G)  float  binary; 

del  eont_st a t e_p r ime  (10)  float  binary; 

del  n  fixed  external; 


del  a_matrix  (1:r/  1:n)  float  eontrolled  external; 


del  i  fixed; 
del  j  fixed; 

doi  =1  ton; 

con  t_s  t  at  e_pr  i  rr  e  (i)  =  0 
d  0  j  =1  ton; 

eon t _s t a t e_p r  i  me  (i)  = 
( i  /  j  )  *  ~  “ 

end; 

end; 


eon t^s t a t e_or i me  (i)  +  (a^matri 
cont_sta  te  ( j )  )  ; 


end  equation_a; 


equation_b;  proeedure  (matrix_dim^  time/  eont.state/  cont_st 
ate^prime);  ~ 

del  matrix  dim  fixed  binary  (35); 

del  time  float  binary; 

del  eont_state  (1G)  float  binary; 

del  cont^state  prime  (10)  float  binary; 

del  e ont , i npu t T 1  :  c )  float  binary  controlled  external; 

del  n  fixed  external; 
del  p  fixed  external; 

del  temp.prime  (1:n)  float  controlled  external; 

del  a.matrix  (1:n/  1;n)  float  controlled  external; 
del  b.matrix  (1;n/  1:d)  float  controlled  external; 

del  i  fixed; 
del  j  fixed; 
del  k  fixed; 

do  i  =  1  ton; 

temp^pr ime  ( i )  =  0 ; 
do  k  =  1  to  p; 

t emo_or i me (  i  )  =  t emp_pr i me ( i )  +  ( b_ma t r i x ( i / k )  *  cont_ 
input(k));  ” 

end  ; 
end; 

do  i  =  1  to  n; 

cont_st at e_or i me  (i)  =  O; 
do  j  =1  ton; 

c on t _ St  a t e_ p r  i  me  (i)  =  cont_stat e_pr i me  (i)  +  temp_pri 
me(i)+(a_matrix(i/j)* 

cont_state  (i)); 

end  ; 
end; 

end  equation_b; 


end  build_discrete_matricies; 

goto  skip^the.entry; 
bu 1  I d_m i s c _a r ra y s :  entry; 
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allocate  offset_s/  cffset_i^  qua n t um^ s t e p_ s i z e _ s /  auantum.st 
e  p_s i ze_ i J 

auantum_step_s i ze_s  =  ( vo I f ag e.uppe r_bo und_ s  -  vo I t age _ I o we r 
_bound_s)  / 

( nu 


mber_of_steps_s) 
of ?set_s  (IT  =  1 ; 
do  i  =^2  to  ni 

offset.s  (i)  =  cffset_s  (i-1)  *  numbe r_o f _ s t ep s_ s  (i-1); 
end  ; 

num  state^combs  *  offset_s  (n)  *  numbe r_of _ s t e os_ 5  (n); 

if  T  p^real  >  0  )  then 
do; 

qua n tum_s t ep_ s  i  ze_  i  =  < vo 1 1 age_uppe r_bound _ i  -  voltage_l 
ower__bound_i  )  ”/  ~  ” 

(num 

ber_of_steps_i)  i 

offset.!  <1)  =  1; 
do  i  =  2  to  p; 

offset  i  (i)  =  offset.!  (i-1)  *  number_o f.steps. i  (i-1 

)  ; 


end ; 

num_ i nput _ com b s  =  offset_i  (p)  *  number.© f. s t eps. i  (p); 
end ;  ” 

else 
do; 

num. i nput. c omb s  =  1; 
offset.!  ( 1 )  =  i; 

Quan tum.s t ep. s i ze. i  (1)  =  i; 
end; 


return; 

goto  s k i o.t he. en t r y ; 
build. cont.reg. sat. edg. arrys:  entry; 


del  found. sat. edge  bit(l); 
del  state.codel  fixed; 
del  input. codel  fixed; 
del  ne X t. s tat e.e ode  1  fixed; 
del  num. sat. edges  fixed; 

allocate  uncon t r o I  I  ab I e.e e 1 1 ^  sat. edge; 

do  state.codel  =  1  to  num.s t a t e.c ombs ; 

uncont ro I  lab  le.ee  1 1  (state.codel)  *  false; 
end; 

found. sat. edge  =  false; 

do  state.codel  =  1  to  num. st at e. combs ; 
do  input. codel  =  1  to  num. i nput. combs  ; 

next  state  codel  =  nex t.s t a t e.map  (state.codel/  input. co 

del); 

if  (  next  state  codel  =  0  )  then 
do; 

sat. edge  (state.codel/  input. codel)  =  true; 
f ound. s a t . edge  =  true; 
end ; 
else 

sat. edge  (state.codel/  input. codel)  =  false; 

end; 
end  ; 

do  while  (  found. sat. edge  =  true  ); 

do  state.codel  =  1  to  num  state.combs; 

if  (  uncontrollable  cell  (state.codel)  =  false  )  then 
do; 

num. sa t. edges  =  O; 

do  !nput.coce1  ~  1  to  num. input. combs; 
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then 


true  ) 


if  (  sat_edge  ( s t a t e_c ode  1 /  inout_code1)  = 
nuin_sat_edges  =  num_sat_edges  +  1* 

end ; 

if  (  num  sat^edges  =  num_ i npu c omb s  )  then 
do;  “ 

un  c  on  t  re  t  L  ab  I.  e_  c  e  L I  (  s  t  a  t  e_  c  ode  1 )  =  true; 
end ; 

end; 

end  ; 

f ound_sat_edge  =  false;  - 
do  state.codel  =  1  to  num^s t a t e^comb s  ; 
do  input_code1  =  1  to  num_inout_combs; 

if  (  sat_edge  ( s t a t e_c ode  1 ^  input^codel)  =  false  )  the 


nex t _ s t a t e_c 0 de 1  *  ne x t_ s t a t e^mao  ( s t a t e.code 1 /  in 

out_code1 ) ; 

if  (  un c ont r 0  1 1  ab le_c e I  I  (ne x t_s t a t e_c ode  1 )  =  true 
)  t  h  en  ~ 

do; 

sat_edge  (state.codel ^  input.codel)  =  true; 
f ound_sa t_edge  =  true; 
end; 

end ; 

end; 

end; 

end; 

num^con t ro I  lab  I e_ c e  1 1 s  =  O; 
do  state_code1  =  1  to  num  state. combs; 

if  (  uncont ro 1 1 ab  le. cell  ( s t ate.codel  )  «  false  )  then 
num. con t ro 1 1  a b I e.c e 1 1 s  =  num.c on t ro 1 1 ab I e. c e 1 1 s  +  i  ; 

end ; 
return; 

goto  skip.the.entry; 

bu i I d.ne X t.s t at e_ f 1  I  e  :  entry; 

del  nex t. state. code  fixed; 

del  state.code  fixed; 

del  input.code  fixeo; 

del  St  a t e.code.t emp  fixed; 

del  input_.code  temc  fixed; 

del  dis. state  t1:n)  fixed  controlled; 

del  ne X t^d i s_ s t a t e  (1:n)  fixed  controlled; 

del  dis.inout  <1:p)  fixed  controlled; 

del  cont. state  (1:n)  float  controlled; 

del  cont.inout  (1:d)  float  controlled; 

del  temp.l  (1:n)  float  controlled; 
ocl  temp.2  (1:n)  flcat  controlled; 

del  not.satura ted  bit(1); 


out  skip; 

put  edit  ("Building  next  state  file”)(skip/  x(4)/  a); 
allocate  dis. state#  dis.input#  ne x t.d i s. s t a t e #  cont.state# 
c  ont . i npu  t  # 

t  emp.1 #  temp.2; 

allocate  ne x t_ s t at e.map; 

do  state.code  =  1  tc  num. state. combs; 

do  input.code  =  1  to  num. i npu t. c omb s ; 
s  t  at  e.c  0  de.  t  erro  =  state.code; 


input_co(Je_t€(rp  =  input.code/' 

call  CO n ve r t _ Sc 0 de_ t o^d i s_s t a t e ( s t a t e_c ode /  dis.state) 
call  convert  Scode^to  dis.input  (inout.code#  dis  input 

)  ; 

st3te_coe)e  =  sta  t  e_code_t  emp; 
input_code  =  i npu t_c ode_ t emp  ; 
call  add.entry; 
end ; 
end; 

free  dis_state#  dis^input#  ne x t_d i s_ s t a t e /  cont.state/  cont 
.input# 

temp.l#  temp_2; 


add.entry:  procedure; 
del  i  fixed; 

call  c on ver t _Sd i s_s t a t e_t o_con t_s t a t e  ( ( d i s_ s t a t e )  #  cont.s 
t  a  te  )  ; 

do  i  »  1  to  n; 
t  emp.l  ( i )  =  0  ; 
doj*1  ton; 

temp.1  (i)  =  temp  1  (i)  +  phi  matrix  (i#j)  *  cont  stat 

e  ( j  )  ; 

end; 

end; 

call  c  onver  t  .$d  i  s  .i  n  pu  t..  t  o_  con  t..  i  npu  t  (  ( d  i  s_  i  npu  t )  #  cont.i 
n out )  ; 

do  i  =  1  to  n; 
temo_2  (i  )  =  C; 
do  3  =  1  to  p; 

temp_2  Ci)  a  temD_2  (i)  +  lambda. mat r i x  (i#  j)  *  cont. 
i nput  ( j ) i 
end; 
end; 

temp.l  a  temp.l  +  temp_2; 

call  c onver t .S c or t.s t a t e. to.d i s_s t a t e  ((temp.l)#  next. dis. 

state); 

not. saturated  *  true; 

do  1  a  1  to  n  while  ( no t.sa t ur a t ed  =  true); 

if  ( ne X t.d i s_ s t at e  (i)  >  number. of. steps. s  (i)  -  1  I 

next. dis  sta 

te  (i)  <  0)  then 

not.s at u ra t ed  *  false; 

end ; 

if  (  not.sa turat ed  =  true  )  then 

call  convert. Sdis.state.to. code  ( ( ne x t .d i s. s t a t e ) #  next, 
stat  e  code ) ; 
else 

ne X t .s t a t e.c ode  =  O; 

next. state. mao  (state. code#  input.code)  =  next.state.code; 

if  (next. state  coce  *=  0)  then  do; 

end; 


end  add.ent  ry  ; 
return; 

s k i 0. t he.en t r y ;  put  skip; 
ena  c h ange.pa r a m e t e r s  ; 


C-32 


procedure; 

del  job_name  c h a r a c te r  (  50 )  varying  external; 

Pel  data_file  file; 
del  1  flag  external/ 

2  cont^exists  bitd)/ 

2  d i s c r e t e_ ex i s t s  bit(1)/ 

2  qua n t i z ed_e X i s t s  bit(1)/ 

2  con t r o I ^  I  aw, V  a  I  i  d  bit(1)/ 

2  sim_valTd  bTt(1)/ 

2  own _au a n t_f i L e_e X i s t s  bit(1); 

del  done  bit(1); 

del  answer  character(3)  varying; 
del  choice  fixed; 
del  choice  c  c har acter (1  )  ; 
del  range  tixed; 

del  num, an swe p,o k  entry  ( c h ar ac t e r ( 1 ) /  fixed/  fixed); 
del  yn,answer_ok  entry  ( c h a rac t e r ( 3 )  varying); 
del  orTnt^nex t,st ate,f i le  entry; 

del  bu i  I  d^t ol, r eg,a nd_ c on t _ I awSpr^con t, I  aw  entry; 
del  cheeky quantization, level  entry; 
del  sysin  file  input; 
del  sysprint  file  output; 

done  =  "Q’'b; 
do  while  (done  =  ''C*‘b)  ; 
put  skio(2); 

put  edit  ("Which  of  the  following  would  you  like  orinted?” 
) (skip/a); 

put  skip; 
range  =3; 

put  edit  ("1,  Status  of  the  job")(skio/a); 
put  edit  ("2.  Data  file  for  the  job")(skip/a); 
if  ( f  I  ag . qu an t i z ec,e X i s t s  -  ”1"b)  then 
do; 

range  *  5; 

out  edit  (”3«  Quantized  data  file  -  next  state  file 
")(skip/a); 

cut  edit  ("A.  Quantization  level  check ”)(skip/a); 
if  ( f  I  ag  .  c  or  t  r  0  I,.  I  a  w_va  I  i  d  =  "1"b)  then 
do; 

range  =  6 ; 

put  edit  ("5.  Control  I  a w”) ( s k i o / a ) ; 
put  edit  ("6.  None  of  the  a b o v e " ) ( s k i p / a ) ; 
end; 
else 

out  edit  ("5.  None  of  the  above ")(skiD/a); 

end; 
else  do ; 

range  =  3 ; 

if  tflaq.contrcl_law  valid  =  ”1"b)  then 
do; 

range  =  A; 

out  edit  ("3.  Control  I  aw” ) ( s k i o/ a ) ; 
out  edit  ("A.  None  of  the  a  bo ve " ) ( s k i p / a ) ; 
end ; 
else 

put  edit  ("3.  None  of  the  above”) ( sk i p/a) ; 

end; 

put  s  k i 0 ; 

put  edit  ("Enter  choice  =>  ”)(skio/a); 
get  list  (choice_c); 

call  num_an s we r ,0 k  (choice_C/  range/  choice); 

if  (choice  =  1)  then 
do; 
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D  u  t  s  k  i  p  ; 

if  (flag.ccrtexists  =  "I'b)  then 

out  edit  (  A  continuous  model  of  the  system  e 

xists") (skip^a) ; 

if  (flag.discrete.exists  =  ’’Vb)  then 

put  edit  ("  A  discrete  model  of  the  system  exi 
sts'')(skiD/a); 

if  ( f  I  ag . quant i zed_ex i s t s =  1  b)  then 

put  edit  (”  A  quantized  model  of  the  system  ex 
ists”)(skio/a)i 

if  (  f  I  aq«  cont  r  0  l_l  au_va  I  i  d  =  ’1''b)  then 

put  edit  (**  A  control  law  exists  for  the  job" 

) (skip/a); 

if  (flag.sirrvalid  =  "1"b)  then 

put  edit  T"  The  system  has  been  successfully  s 
imulated")  (skip^a); 
end; 

if  (choice  =  2)  then  call  d i s p I ay_ j ob. f i  I  e ; 
if  (choice  =  3)  then 
do; 

if  (range  =  3)  then  done  =  "1"b; 

if  (range  =  4)  then  call  bu i I d_ t o I . r eq_a nd.con t _ I  aw S 
p  r  cont  law; 

if  (range  =  5  I  range  =  6)  then  call  p r i nt _nex t_ s t a t 

e. f i  I  e; 

end ; 

if  (choice  =  4)  t  hen 
do ; 

if  (range  =  4)  then  done  =  "1”b; 

if  (range  =  Strange  =  6)  then  call  c h e c k^quan t i z a t i o 

n, level; 

end ; 

if(choice  =  5)  then 
do; 

if  (range  =  5)  then  done  *  "1'*b; 

if  (range  =  6)  then  call  bu i I d_ t o l^ r e g_a nd_c on t_ I  a w$ 
pr_cont^law; 

end; 

if  (choice  =  6)  then  done  =  "1"b; 

end;  /*  while  */ 
goto  endi t ; 

d  i  s p  I  ay_ j ob_ f i I e :  entry; 

out  edit  ("OOPs  I  haven’t  written  this  one  ye t  '  " ) ( s k i p ^ a ) ; 
return; 


endit:  end  print_it; 


C-34 


print_next_state^fi  le;  procedure; 


del  num_state_combs  fixed  external; 
del  num_ i nput _ c om b s  fixed  external; 

del  ne X t.s t at e_ f i  I  e_p t r  pointer  external; 

del  ne X t _st a t e_ma p  <1 : num^state_combs^  1  :  num_ i nput _combs )  fi 
xed  controlled  external; 

del  the_next_state  mapping  ( 1 : num_ s ta t e_comb s ^  1  : n i np ut_c 
ombs)  fixed  binary  (T8) 

unsigned  based  ( nex t_s t a t e_ f i I e_p t r ) ; 

del  yn_ansuer_ok  entry  ( c harac t e r ( 3 )  varying); 
del  sysin  file  input; 
del  sysprint  file  output; 

del  i  f  i  xed ; 
del  j  fixed; 
del  count  fixed; 

del  answer  character  (3)  varying; 

put  edit  ("Would  ycu  like  the  next  state  file  printed'*  =>  ") 
(  sicip^a)  ; 

get  list  (answer); 
call  y n_an swe r _o k  (  arsw e r ) ; 
if  (answer  =  "yes"  I  answer  =  "y")  then 
do  ; 

c  oun  t  =  n ; 

do  i  *  1  to  num.st ate.combs; 
count  *  count  +  i; 
i f  (count  *11)  t  hen 
do; 

count  *  1; 

out  edit  ("More?  »>  ")(skip#a); 
get  list  (answer); 
call  yn_answer^ok  (answer); 
put  skip; 

if  (answer  *  "n"  I  answer  *  "no")  then  goto  nomor 

e ; 

end; 

put  edit  ( i ) ( sk i p / f ( 4) ) ; ; 
do  j  =  1  to  rum_ i nput_combs; 

out  edit  ( n ex t _ s t a t e^map  (i/  j))(x(2)^  f(7)); 
en  d; 
end ; 
end; 

nomore:  put  skip; 

end  p r i nt _ne X t_ s t a t e_ f i I e ; 
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check_auantizat ion^  level  :  orocedure; 

del  n  fixed  external; 

del  p  fixed  external; 

del  p_real  fixed  external; 

del  num^s t ate_ combs  fixed  external; 

del  num_ i nput_combs  fixed  external; 

del  offset_s  (Irn)  fixed  controlled  external; 

del  offset_i  (1:p)  fixed  controlled  external; 

del  numb e r~of _ s t e 0 s_s  (l:n)  fixed  controlled  external; 

del  number_of_steps_i  (1:p>  fixed  controlled  external; 

ocl  VO  1 1 age_lower_bcunc_s  (1:n)  float  controlled  external; 
del  VO  1 1 age_l 0 we r_boun d_ i  (1:p)  float  controlled  external; 
del  oua n tum^s t eo_s i 2e_s  (1:n)  float  controlled  external; 
del  quantum_s t ep^s  i  2e_  i  <1:p)  float  controlled  external; 
del  num_ con t r o 1 1  a b I e_c e 1 1 s  fixed  external; 

del  ne X t_st at e_ f i I e^p t r  pointer  external; 

del  state  (1:n)  fixed  controlled; 
del  input  (1:p)  fixed  controlled; 
del  next^state  (1;n)  fixed  controlled; 

del  next  state^map  (1 : num^sta te_combs #  1 : num_ i nout_combs )  fi 
xed  controlled  external; 


del  the_next_state  (rapping  ( 1  :  num_s  t  a  t  e_comb  s  /  1  :  num_  i  np  u  t_c 
ombs)  fixed  binary  (Tfi) 

unsigned  based  ( ne x t_s t a t e_f i I e_p t r )  ; 


del  answer  character(3)  varying; 


dc  I 
dc  I 
dc  I 
dc  I 
dc  I 


convert.Sd i s^state_to^code  entry 
conver t_$d i s_ i r cut ,to_code  entry 
convert^Scode.tc.d is.state  entry 
convert_*code_to_dis„input  entry 
yn_answer_ok  entry  ( c ha r ac t e r ( 3) 


( ( * )  fixed/ 
( ( *>  fixed/ 
(fixed/  ( * ) 
(fixed/  (★) 
varying) ; 


fixed); 
fixed); 
fixed); 
f i xed) ; 


del  sysin  file  input/ 
del  sysprint  file  cutout; 


put  edit  ("Would  you  like  to  check  the  Quantization  level 
")<skip/a); 

get  list  (answer); 
call  yn_answer_ok  (answer); 
if  (answer  =  "yes"  I  answer  =  ”y")  then 
do; 

out  edit  ("Nu(rber  of  controllable  cells  =  ")(skip/a); 
put  list  ( num_c cn t r ol I ab I e^c e  I  I  s)  ; 

put  edit  ("  Total  number  of  cells  =  ")(skip/a); 

put  list  ( num.s tat e.combs ) ; 
put  skip; 

allocate  state/  input/  next_state; 
call  f i nd_ ze r 0  i npu t_d i s t s ; 

if  (  p_real  >  C  )  then  call  find_2ero_state_dists; 
free  state/  input/  next_state; 
call  print_sat  edge_array; 

if  ( num_c on t r o I  lab  I e  ce 1 1 s  “=  num_s t at e_combs)  then  do; 
call  p r i n t _c on t r ol  lab  I e  c e I  I  s ; 
call  0 r i n t _unc on t r o  I  labTe_c e  1 1 s ; 
end; 
end ; 


find^2ero^input_dists:  orocedure; 
del  i  fixed; 
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del  s.level  fixed^ 
act  state,  code  fixed.’ 
del  s t at e_c o de_ t emo  fixed; 
del  ne X t. St  a t e.c ode  fixed; 
del  z e f 0. i nou t. c ede  fixed; 
del  sum^num.stecs  fixed; 
del  max_num_st eos  fixed; 
del  num^tot  fixed; 

del  zero. input  (1:d)  fixed  controlled; 
del  num  dir  <1:n)  fixed  controlled; 

del  ce  lls. moved. tot  (Q:sum  num_steos)  fixed  controlled; 
del  c e  1 1  s.moved.d i r  (1:n#  0 : ma x.num.s t eos  )  fixed  controlle 
d; 

ma x.num_s t eps  =  nu mbe r.of .s t ep s.s  (1); 
sum^num  steps  =  O; 
do  1  =T  to  n; 

m a x.num. s t e c s  =  max  (max.num  steps^  number.of  steps  s 

( i ) )  ; 

sum.num.st eps  =  s um_num.st eps  +  number^o f. st eps. s  (i); 
end  ; 

allocate  zero. input/  num. dir/  ce 1 1 s.moved. tot /  cells. mov 
ed.d i r ; 

zero  input  =  floor  (  -vol  tage.,lower_bound.  i  /  quantum  st 
ep.s i ze.i ) 7 

call  conve r 1. 1 d i s. i npu t.t o.c ode  ( ( ze ro_ i npu t )  /  zero.inou 
t.code) ; 

do  state.code  =1  to  num^state. combs; 
state. code. t emp  =  state^code; 

call  convert. Jeode. to  dis. state  (state.code/  state); 
state.code  *  stat encode. temp; 
call  compute.zero.i nput.di sts; 
end  ; 

call  print. zero. input. dists; 

free  zero. input/  num.dir/  ce 1 1 s.moved.t ot /  cel  I s.moved.d 

i  r  ; 


compute. zero. input. dists:  procedure; 

if  (  ne X t. s t a t e.ma p  (state.code/  ze ro. i npu t.code)  >  0  ) 

then 

do  ; 

next. state  code  =  next  state. map  (state  code/  zero  i 
nput.code)  ;  ” 

call  convert.Scode.to.di s.sta te  ((next  state.code)/ 
next. St  at  e) ; 

num.dir  =  abs  (state  -  next. state); 
num. tot  »  C; 
do  1  =  1  to  n; 

c e I  I s.m 0 ved. d i r  ( i  #num.d i r ( i ) ) =  cells  moved  dir  (i 
/num.dir(i))  +1;  ~  ” 

num. tot  =  num. tot  +  num.dir  (i); 
end ; 

ce I Is.mov ed.t 0 t  (num.tot)  =  cells  moved  tot  (num  tot 
)  +  i;  -  -  - 

end; 

end  c ompu te. ze r o.i npu t.d i s t s ; 
print. zero. input. dists;  procedure; 
del  i  fixed; 
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del  j  fixed; 

del  ma  X  _c  e  I  I  s  _rrove  d  fixed; 

del  most_cells_'Toved  (1:max_num_steDs)  fixed  controlled; 

del  zero,  c  e  1 1  s.irovec  bit(1); 
del  true  bit(lT  initial  (*'1"b); 
del  false  bit(1)  initial  ("Q”b); 

allocate  m os t _ c e 1 1 s_mo ved ; 

doi=1  ton; 

2 ero_ce I  I s_moved  =  true; 

do  j  =  max_nijrr_s  teps  by  -1  to  0  while  (  z  e  r  o_  c  e  I  I  s  _  mo  v  e 
d  =  true); 

if  (c  e  I  I  s_frcved_di  r  (i^  j)  >  0  )  then 

do;  ~ 

z e ro« c e  1 1 s .moved  =  false; 
mo s t. c e  1 1 s _mo ved  (i)  =  j; 
end ; 

end; 
end  ; 

ma x^ce I Is.moved  =  mos t_ce I  I s.moved  (1); 
do7=1  ton; 

max^cells  moved  =  max  (max  cells  moved^  most  cells. mov 

ed  (i)); 

end  ; 

put  edit  ("Number  of  cells  moved  in  each  d i r ec t i on" ) ( s k i 
p^x(6)#a); 

put  edit  ("0ir")(skio^a^x(3)); 
do  i  »  0  t 0  ma x.e e 1 1 s.moved; 

put  edit  (i)(?(4)); 
end ; 

do  i  »  1  ton; 

put  edit  (i)(skip^f(4)#x(3)); 
do  j  =  0  to  m ax. ce 1 1 s.mo ved; 

put  edit  ( c e 1 1 s.mowed.d i r  (i^j))  (f(4)); 
end; 
end; 

zero. cell s. moved  «  true; 

do  i  *  sum. num. steps  by  -1  to  0  while  ( ze ro.ee  1 1 s. moved 
=  true)  ; 

if  (  ce I  I s. moved. tot  (i)  >  0  )  then 
do; 

zer o.ce  1 1  s.mcved  =  false; 
max.ee  I  I  s. moved  =  i; 
end; 

end  ; 

put  skip; 

put  edit  ("Number  of  cells  moved  total ")(skip^x(6)/a); 
put  edit  ("num")(skio»a); 
do  i  =  0  to  max.ee  I  Is. moved; 

put  edit  (i)(f(4)); 
end; 

put  edit  ("  ")(skio^a); 

do  i  =  Q  to  ma x.ce 1 1  s.moved; 

out  edit  ( c e  I  Is. mo ved. t 0 1  (i))(f(4)); 
end  ; 

free  most.ee  I  I s.moved; 

end  print. zero. input. dists; 

end  f i nd.ze ro. i npu t.di s t s ; 

find. zero. state. dists:  procedure; 

del  i  fixed; 
del  j  fixed; 
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del  i nout.c ode  f  i  xed ; 

del  n e X t _ s t a t e_ c c de  fixed; 

del  z e r o_st a t e~ code  fixed; 

del  zero^state  (1:n)  fixed  controlled; 

del  zero^inout  (1:p)  fixed  controlled; 

del  num  input^steps  (1:p)  fixed  controlled; 

del  c e I T s_mo ved_ t ot_ ab s  <1:o)  fixed  controlled; 

del  c e  1 1 s~m 0 ved_d i r_ ab s  (1:o#  1:n)  fixed  controlled; 

del  cells  (7ioved_tct_avg  dtp)  float  controlled; 
del  c e 1 1 s_mo ved_d i r_ a vg  (1:p#  1:n)  float  controlled; 

del  input_status  <1:p)  character(9)  controlled; 

del  f  ound_n  0  t^s  a  t  bitd); 

del  true  bit(T)  initial 

del  false  bitd)  initial  <”0'*b); 

allocate  zero_state^  zero^inout#  num_  i  nput_s teos #  cells^mo 
ved_tot_abs# 

ce  I  ls_nicved_tot^avg^  ce  1 1  s^moved^d  i  r^abs#  cells, 
moved. di r.avg# 

input_ status; 

zero. state  =  floor  ( -vo I t age. I ower^bound_ s  /  qua ntum_s t ep_ 
size.s); 

zero. input  =  floor  ( -vo I tage. I  owe r.bound. i  /  quan tum.s t ep. 
s i ze_  i )  ; 

call  conver  t  .Sd  i  s.s  t  a  t  e_  to.code  (  ( ze  r  o.s  t  a  t  e  ) zero. state, 
code); 

call  comout e.zer o.s t a t e^di s t s ; 
call  pr i n t.z e ro.s ta t e.d 1 sts; 

free  zero.state/  zero. input/  num. i npu t. s t ep s /  cells. moved, 
t  0 1_  a  b  s  / 

c el  I s.moved.tot .avg/  ce 1 1 s.moved.di r.ab s/  cells. move 
d.di r.avg/ 

i nput. status; 


compute. zero. state.dists:  procedure; 

do  i  =  1  to  p; 

input  =  zero.input; 
f ound.not.s at  =  false; 
input  (i)  *  O; 

do  while  (input  <i)  <  zero.input  (i)  S  found. not  s 
at=false); 

call  c on ve r t.$d i s. i nput. t o.c ode  ((input)/  input. code 

)  f 

if  (  n ex t .s t at e.map  ( z ero. s t a t e. code/  input. code)  > 

0  )  then 

found. not. sa t  =  true; 
else 

input  (i)  =  input  (i)  + 

end; 

if  (  found.not.s at  =  true  )  then 
do  ; 

if  (  input  (i)  =  0  )  then  input. status  (i)  =  "max 

u  n  s  a  t  "  ; 

else  input. status  (i)  =  "max  satur"; 
num. input. St eps  (i)  =  zero.input  (i)  -  input  (i); 
nex t .s t a t e.c ode  *  next.state.map  ( z e r o.s t a t e.c ode  / 
input. code) ; 

call  c on ver t .Sc ode. t o.d i s.s t a t e  ( ( ne x t.s t a t e.c ode ) 
/  next. state); 

cel  I s.moved.di r.abs  (i/*)  =  abs  (next. state  -  zero 
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.state); 

c e L I s_m c ved_ d i r  avq  (i#*) 

/ 


1 


) 


nput.s  t  eos  (  i  )  ; 

cel  I s.moved.tot.abs  (i)  = 
do  i  =  1  to  n; 

c e I  I s.moved.tot  abs  (i) 

+ 


d.di r.abs  (  w  j  )  ; 

end; 

cel  I s.moved. tot.avg  (i)  = 


c e 1 1 s _mo ve d_ d i r_ ab s  (i 

nun 


De¬ 


ceit  s.moved.tot.abs  (i 
cell s.move 


c e I  I s.move d_ to t.ab s  Ci) 


nun 

.input.steps  (i); 

end ; 
else 

input.status  (i)  =  “all  satur"; 

en  d; 


end  compu te_ zer o.st a t e.d i St s ; 


print. zero.state.dists:  procedure; 


put  skip; 
put  edit  ("Input 
lls  Moved") ( ski p^a) ; 
put  edit  (" 
in") (skip^a) i 


Input  Nun 

Status  Input 


Total  Cells 
Moved 


Ce 


out  edit  ("  Steps  Abs  Awg  0 

ir  Abs  A vq" ) ( s k  i  p ) ; 
do  i  «  1  to  p; 
out  skip; 

if  (  input. status  <i)  =  "all  satur"  )  then 
do; 

put  edit  (i^  input.status  ( i ) ) ( x ( 4 ) / f ( 4 ) ^ x ( 3 ) ^ a ( 9 ) 

)  * 

end; 
else 
do ; 

put  edit  <i^  input. status  (i)^  nun. i nput. steps  (i) 

(f(4)/-  x(3)^  a  (9)/  x(3)^  f(4)); 
put  edit  (ce  I  Is.moved.tot.abs  (i)/  cells  moved  tot 
.avg  (i),  "  ") 

(x(4)^  f(4)/>  a); 

do  j  s  1  to  n; 

out  edit  (i/  cells  moved. dir  abs  (i^j)#  cells  mo 
ved.dir.avg  (i^ j  )^  "  ") 

(skip^  x(42)^  f(4)^  x(2)^  f(4),  x(5)^  f(6^2)-r  a) 

end  ; 
end  ; 

end; 

put  skip; 

end  print. zer o. state.dists; 
end  f i n d.z e ro. s t a t e.d i s t s ; 


print. sat. edge. array:  procedure; 

del  num. s t a t e. comb s  fixed  external; 
del  num. i npu t . c om b s  fixed  external; 
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del  sat_edge  (  1  ;  n  un)_s  t  a  t  e_combs  ^  1  :  num_  i  nou  t  _  c  ombs  )  bit  (1) 
controlled 

external^ 

del  yn_answer_ok  entry  (  c h a r a c t e r ( 3 )  varying); 
del  sysin  file  input; 
del  sysprint  file  output; 

del  i  f  i  xed; 
del  j  fixed; 
dc I  count  f ix  ed; 

del  answer  character  (3)  varying; 

put  edit  ("Would  you  like  the  saturated  edge  array  printed'’ 
") (skip^a); 

get  list  (answer); 
call  yn^answer_ok  (answer); 
if  (answer  =  "yes"  I  answer  *  "y")  then 
do; 

count  =  O; 

do  1  =  1  to  nunr^st  ate^combs; 
count  =  count  +  i; 
i f  (count  =  11)  then 
do; 

count  =  1 ; 

put  edit  ("More?  =>  ")(skip#a); 

get  list  (answer); 

call  yn^answer^ok  (answer); 

;3ut  rkip; 

if  (answer  =  "n"  I  answer  =  "no”)  then  goto  nomor 
e; 

end; 

put  edit  ( i )  (  sk i p/ f ( 4) ) ; ; 
do  i  *  1  to  nuni^  i  nput^combs; 

if  (  sat^edge  (i#  jT  =  "0"b  )  then  put  edit  ("  F" 

)  (a)  ; 

else  put  edit  ("  T")(a); 

end; 
end; 
end  ; 

nomor e;  out  sk i p; 
end  pri  nt_sat^edge_array  ; 
print^controllable^ cells:  procedure; 
del  num^s t a te_ comb s  fixed  external; 

del  un c ont rol I ab I e_ce I  I  (1 :num_state_combs)  bit(1)  controlle 
d  external; 

del  i  fixed; 
del  count  fixed; 

del  answer  char3cter(3)  varying; 
del  sysin  file  input; 
del  sysprint  file  output; 

del  yn_answer_ok  entry  ( ch arac t e r ( 3 )  varying); 

put  edit  ("Would  you  like  the  controllable  cells  listed  ") 
(sxip^a)  ; 

getlist(answer); 
call  yn_answer  ok  (answer); 
if  (  answer  =  "yes"  I  answer  =  "y"  )  then 
do; 

count  =  O; 

put  edit  ("Controllable  Cells ")(skio^a); 
do  i  =  1  to  num^st ate^combs; 
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if  (  uncontrollable_celL  (i)  =  ''n”b  )  then 
do  /■  ~ 

put  skip  list  (i); 
count  =  count  + 
i f  ( count  =  10)  then 
do ; 

count  =  1 ; 

put  edit  ("Wore?  =>  ")(skio/a); 
get  list  (answer); 
call  yn_answer_ok  (answer); 
put  skip; 

if  (answer  *  "n"  1  answer  =  "no") 

nomor e : 

end; 

end ; 

end; 

end; 

nomore;  put  skip; 
end  p r i n t _c on t r 0  1 1  a b  I  e_c e  1 1 s ; 
orint_uncontrollable_cel  Is:  procedure; 
del  nufn_state_combs  fixed  external; 

del  un c on t r ol I ab I e_ce I  I  ( 1 : num_s t a t e_ co mbs )  bit(1) 
d  external; 


del  count  fixed; 
del  i  fixed; 

del  answer  character(3)  varying; 
del  sysin  file  input; 
del  sysofint  file  output; 

del  yn_answer_ok  entry  ( c ha ra c t e r ( 3 )  varying); 

put  edit  ("Would  you  like  the  uncontrollable  cells 
" )  (  s  k  i  pv  a )  ; 

get  list  (answer); 
call  yn_answer  ok  (answer); 
if  (  answer  =  yes"  I  answer  =  "y"  )  then 
do; 

count  =  O; 

put  edit  ("Uncontrollable  Ce I  I s") ( s k i p^ a ) ; 
do  i  =  1  1 0  nutp^st  ate_combs; 

if  (  uncontroTlable_cell  (i)  =  "1"b  )  then 
do; 

put  skip  list  (i); 
gount  =  count  +  1  ; 
if  (count  =  11)  then 
do; 

count  =  i; 

put  edit  ("Hore?  =>  ")(skio^a); 
get  list  (answer); 
call  yn_ansuer_ok  (answer); 
put  skip; 

if  (answer  =  "n"  I  answer  =  "no") 

nomore; 

end; 

end; 

end; 

end; 

nomoreroutskip; 

end  p r i n t _unc on t r ol I abl e_ce I  I s; 

end  c hec k_ Guant i z a t  i  cr_ I e ve I ; 


then  goto 


con  t  r o  I  I  e 


listed  ? 


then  goto 
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build_toL_reg_and_cont_Law;  procedure; 

del  nu s t a t e_ com b s  fixed  external; 
del  1  flag  external/ 

2  cont_exists  bitd)/ 

2  d i sc r et e  e X i s t s  bit(1)/ 

2  quan t i zed_ex i St s  bit(1)/ 

2  cont r 0 l^  I  au^v a  I  i d  bit(1)/ 

2  sim_valid  bit(l)/ 

2  oun_ q ua n t _ f i I e_e X i s t s  bit(1); 

del  cost^function.ccde  fixed  external; 
oc  I  ce  I  l^st  at  u  s^i  ndex  fixed; 
dc I  cent er_ce I l_t 0 ler ance  fixed; 

Gcl  edge^ce 1 1_ to  I e r anc e  fixed; 

del  cell^status  ( 1  : num _s t a t e_c omb s )  fixed  controlled; 
del  center^dist  ( 1 ; num_s t a t e_c omb s )  fixed  controlled; 
del  f ou nd_a 1 1_  loop s  bit(1); 

del  control_law_f  i  le_ptr  pointer  external; 

del  control_law  ( 1  :  num _s t a t e_c ombs )  fixed  based  (control_law 
. f i I e_ot  r  )  ; 
del  i  fixed; 

acl  answer  character(3)  varying; 

del  min_time  opt  eont^law  entry  (  (*)  fixed/  fixed); 
del  yn_answer.ok  entry  (character  (3)  varying); 
del  sysin  file  input; 
del  sysprint  file  output; 


allocate  cell^status/  center^dist; 

if  ( f L ag. cont r 0  l_  I  a w_ V  a  I  i d  *  "1"b)  then 

put  edit  ("Would  you  like  to  rebuild  the  control  law  file 
?  ")(skip  (2)/a); 
else 

put  edit  ("Would  you  like  to  build  the  control  law  file? 
")(skip(2)/  a); 

get  list  (answer) ; 

call  yn_answer_ok  (answer); 

if  (  answer  ~  "y"  I  answer  =  "yes"  )  then 

do  ; 

call  build_cost_ftjnction; 

if  ( cost_funct i cr^code  *  5  I  c o s t_f un c t i on_c ode  =  6)  then 

do; 

goto  dont_bui  Id; 

end; 

call  g e t _to I e r a n c es  ( c en t er.c e I l_ to  I e r anc e/  edge.ce I  I _ t o  I  e 
ranee)  ; 

call  i ni t ia I i ze^cel l_status_array  ( ce  I  l_s t a t us /  edge_cell_ 
tolerance); 

call  i ni t i a  I i ze^c ent e r_d i st_ar r a y  ( c en t e r_d i s t /  center^cel 
l_tolerance); 

call  f i nd_root_ce  1 1 s  ( ce I l_s t a t us/  center_dist/  center^cel 
l.tolerance/ 

cel l  status_i ndex)  ; 

call  open^contro  l_law_f i le/ 

call  f ind_l ooD3^ard^cont_law  ( c e I l^ s t atus /  center_dist/  ce 
I l_s t a t u s^ i ndex /  c en t er_ ce 1 1  to  I eranc e/  f ound_a I  I  loops ) ; 

if  ( f ound^a I  l^  I  oops  =  "0"b)  then  goto  donI_build; 

call  bu  i  I  d_op  t  i  ira  I  _cont  ro  l_  I  aw  ( c  e  I  l_s  t  a  t  u  s  /  cell_status 
_ i nde  X ) ; 

f  I ag  .  s i m_va I i d  =  "0"b; 

f I ag . c on t ro l_ I  a va I i d  =  "1"b; 


caU  print_ceLl_status  ((ceU.status)); 

T c 0 s t_ c t i cn_co ae  *=  6  5  f  I  ag, cont ro L_ I au_v a  I i d 

b  )  t  h  en 

call  p r i n t _c 0 n t ro I _ I au » 

end; 

free  cell^status#  center_dist; 


bu i  I  d_ c o s t _ f u n c t i on  :  procedure; 


dc  I  1 


flag  external/ 

2  cont _ e X i s t s  b  i  t  ( 1 )  / 

2  d i  sc r e t e _ e X i s t s  bit(1)/ 

2  cuan t i ze G_ ex i s t s  bit(1)/ 

2  c ont r 0 1 ^  I  au,v a  I i d  bit(l)/ 

2  si  m_  valid  bit(1>/  . 

2  0  wn_  q  uan  t  _  f  1  I  e_e  X  1  St  s  bitd)/ 

true  bitd)  initial 

false  bitd)  initial  (''0**b); 

working_dir  c  lia  r  ac  t  er  ( 1  68 )  external/ 
n  fix ed” ex  t  e  r na I ; 

0  fixed  external; 
p  real  fixed  external; 

cost  funct i on^code_char  c na r act er ^ C i ; » 
cost~functi cn^code  fixed  external/ 
control  law  file_ptr  pointer  external; 


state.cost.matri x 
input.cost^watri x 


(1:n)  float  controlled  external; 
(1:0)  float  controlled  external/ 


del  range  fixed; 
deli  fixed/ 

del  bit^count  fixed  bin(24); 

del  code  fixed  bin(35);  /■-,/,>  *  •• 

del  own_cont rol«law_f 1 le  c h a r ac t e r ( 70 )  external/ 

del  control.law  d : n uf _s t at e.combs )  fixed  based  (control_l 
aw_fi  le.ptr); 

dclnullbuiltin; 

del  num  answer^ok  entry  (  c h a r ac t er d ) /  d * « 9 ' d ’ * ? ° ^ % 
del  hes  Sini tiate.count  entry  ( c ha r  ( *  )  /  c ha r  ( *  )  /  c h a r ( * ) / 
”  fixed  bin(24)/  fixed  bin(2)/  ptr/  fixed  bin 

(35))/' 

del  s y s i n  f i  I e  i  nput ; 
del  sysprint  file  output/ 


( f I ag. cont r 0  I  I aw_v a d d  = 
f I ag . c on t r 0  I _T a w_va I i d  =  ' 
if  (cost_function_code  =  i 


if  ( c os t _ f u nc t i on_c ode  =  2) 
free  sta  te:.ccst_mat  ri  x; 
free  in  pu  t_  c  c  st_  ira  t  r  i  x; 
end; 

if  (cost  function_code  =  3) 
end; 


”1”b)  then 
0’’b; 

)  then  do ; 


then  free  inout_cost_matrix; 


out  edit  ("Which  type  of  cost  function  would  you  like  to  u 
'»")  (sk  io/a) ; 


skip; 
edit  ("D 
edit  ("2) 
edit  ("3) 
edit  ("4) 


^linimutn  Ti  me"  )  (  s  k  i  p  /  x(4)/  a); 
Quacratic")(skio/  x(4)/  a); 

Minimum  Control  Effort ")(skio/  x(4)/  a)/ 
Custom  Cost  Function  (use  procedure  custom.c 
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OS function. pll”) 

(skip/  x(A)/  a); 

put  edit  ("5)  None  -  Would  like  to  access  a  control  law  fi 
le'*)(skio/  x(4)/  a); 

put  edit  ("6)  None  of  the  above") (sk i p/  x(4)/  a); 
put  edit  ("  ”)(skio/a); 

put  edit  ("Please  choose  one  =>  ")(skip/a)) 

get  list  ( c 0 s t_ f unc t i on_c ode.c h a r ) ; 
range  =  6; 

call  num  answer_ok  ( c o s t _f unc t i on_c od e_c h a r /  range/  cost  f 
unct i on.codeT; 

goto  case  ( c o s t _f unc t i on_c ode )  ; 
case  (1):goto  done; 


case  ( 2 ) 


>  ") 


allocate  st a t e_c os t _ma t r i x /  i npu t _c o s t_ma t r i x  ; 
out  skip; 

put  edit  ("Enter  the  value  o f ,..")( s k i p/ a ) ; 
put  skip; 
do  i  =  1  to  n; 

put  edit  ("state  cost  matrix  ("/i/"/"/i/")  =>  ") 
(x(4)/  a/  f(3)/  a/  f(3)/  a); 
get  list  < state^cost^matr i X  <i)); 
end  ; 

put  skip; 

if  (  p^real  >  0  )  then 
do; 

do  i  s  1  to  p; 

put  edit  ("input  cost  matrix  (  "/ i / "/"/ i / ")  = 

(x(4)/  a/  f(3)/  a/  f(3)/  a); 
get  list  (input^cost.matr  ix  (i))# 
end; 
end; 
else 

i  npu t «cos t _ma t r i X  (1)  «  O; 
goto  done; 


case  (3):  if  (  p.real  >  Q  )  then 
do ; 

allocate  input_cost  matrix; 
if  (  P^real  >  T  )  tRen 
do  ; 

put  skip; 

put  edit  ("Enter  scaling  factor  for,..")( 

s  k i p/ a) ; 

put  skip; 
do  i  s  1  to  p; 

put  edit  ("Input  ("/i/")  =>  ">(a/f(3)/a 

) ; 

get  list  ( i nput_cost_mat r i X  (i)); 
end  ; 
end.; 
else 


i  npu t _cos t_ma t r i X  (1)  =  i; 
en  c ; 

else 

put  edit  ("System  has  no  input, 

a k es  no  sense") 


(skip/  x(4)/  a); 

goto  done; 


This  control  m 


case  (4):  goto  done; 


case  (5);  out  edit  ("Enter  the  name  of  the  control  file  to 
be  read  in  =>  ")(skip/a); 

get  List  ( own^ con t r o l_  I  aw_ f i I e ) ; 
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call  h c s _ ^ i n i t i a t e _ cou n t  (workinq  dir/  own  control  law  file/ 

»t  If  —  •  • 

/ 

bit.count/  0/  con t r o I _ I aw_ f i  I  e_p t r  /  c 

ode); 

if  ( c on t ro I _l a w_f i I e_p t r  =  null)  then 
do ; 

put  edit  ("The  file"/  own_con t r ol_ I aw_ f i I e /  "does  not  ex 
ist") (skip/a); 

put  edit  ("Try  Aqain  =>  ")(skip/a); 
get  list  ( own _ c on t r o  l_  I  aw  file); 

call  he s_ S i n i t i a t e_coun t  Two r k i ng_d i r /  own_control  law  f 

i  I  e/ 

""/b i t. count /  0/  c on t r o I _ I  a w_ f i I e_p t r / 

code)  ; 

if  ( c on t r 0  I _ I  a w_f i I e_p t r  =  null)  then  goto  done; 
else  do ; 

H ag, con t ro  I  law_va I i d  =  true; 
end  ; 
end; 

else  do; 

f I ag . con t ro I _ I  aw  valid  =  true; 

end; 

case  (6):  goto  done; 


done:  put  skip; 

end  build^cost.function; 


ge t _t o I e r ance s :  procedure  ( c en t e r_c e 1 1 . t o  I  e r an c e /  edge^cell. 
tolerance); 

del  center^c e I l^tol e ranee  fixed; 
del  edge.ce I l.t c lerance  fixed; 

del  sysin  file  input; 
del  sysorint  file  output; 

put  edit  ("Enter  the  center  cell  tolerance  =>  ")(skio/  a)# 
get  list  (c ent e r_ cel l_ t o I er anc e) ; 

put  edit  ("Enter  the  edge  cell  tolerance  =>  ")(skip/  a); 
get  list  (ed ge_ c e  1 1. 1 o  I  er an c e  ) ; 

end  ge t _ 1 0 L er a nc e s  ; 


in i t i a  I i ze.ce I  I _ s t a tu s.a r ray :  procedure  ( c e I  I _ s t a t u s /  edge_c 
el l_ tolerance); 

del  cell_status  (*)  fixed; 
del  edge_ce I l_t 0  I  er ance  fixed; 

del  n  fixed  external; 

del  num_state_combs  fixed  external; 

del  number_o f_s teos_s  (1;n)  fixed  controlled  external; 

del  un  c  on  tr  0  1 1  ab  I  e_c  e  1 1  (1 :  num_s  t  a  t  e_  comb  s  )  bitd)  control 
led  external; 

del  state_code  fixed; 

del  r e cu r se_ I e V e  I  fixed; 

del  dis_ state  (1:n)  fixed  controlled; 

del  true  bit(1)  initial  ("1"b); 
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del  convert_$dis_state_to.code  entry  ((*)  fixed/  fixed); 


allocate  dis^state; 

cell_status  =  2 ! 
r ecur s e^ I  eve  I  =  n; 
call  clear_all_but_edges; 
do  state^code  =  1  to  num  state_combs; 

if  (  uncon t ro  1 1  ab I e_c el  I  (  state^code)  =  true  )  then 
cell.status  (state_code)  =  i; 

end; 

free  dis.state; 

c lear^a I l_bu t^edges ;  procedure  recursive; 

if  (  re curse_  level  <*  Q  )  then 
do; 

call  c on V ert.Sd i s^st at e_t opcode  ( ( d i s_ s t at e ) /  state_ 

code); 

cell.status  (state^code)  »  0; 
end; 
else 
do; 

do  dis^state  ( r e cur se_ t e ve I )  =  edge_c e I l_t o t er an c e  t 
o 

( number_of _steps^s  ( recur se. I  eve  I )  -  (edge_cell_ 
tolerance  ♦  1)); 

r ec u r se^  I  eve  I  =  recurse^leve I  ”  l; 
call  c I e a r_a I l^but^edges ; 
end; 
end; 

recurse.level  »  recurse_level  +  i; 
end  clear. at l_but«edges; 
end  initial  ize.ee  1 1. St atus.array; 


in i t i a  I i ze.cen ter.di St .ar ray:  procedure  ( c en t e r .d i s t /  center 
.cell.tolerance) ! 

del  center.dist  (*>  fixed; 

del  center. cell.tolerance  fixed; 

del  n  f i xed  e X t e r na  I  ; 

del  i  fixed; 

del  r e cu r se. I  eve  I  fixed; 

del  c en t er. c e 1 1 . t cl.  i  ndex  fixed; 

del  state. code  fixed; 

del  dis. state  (1:p)  fixed  controlled; 
del  zero. dis  state  (1:n)  fixed  controlled; 
del  l.bound  Tl:n)  fixed  controlled; 
del  u.bound  (1:n)  fixed  controlled; 

del  cont. state  (1;n)  float  controlled; 

del  convert  Scont  s t a t e.to.d i s.s t at e  entry  ((*>  float/  (*) 
fixed); 

del  convert. $di s.sta te.to.code  entry  ((*)  fixed/  fixed); 


allocate  dis. state/  zero.di s.st at e/  cont.state/  l.bound/  u 
bound; 

c enter. di St  =  0; 
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cont.state  =  G»’ 

call  c  on  ver  t  _$  c  o  n  t_s  t  at  e_t  o_d  i  s_  s  t  a  t  e  ( (  c  on  t  _ t  a  t  e)  #  zero_ 
dis_ state); 

do  center  cell  tcl_index  =  c en t e r_c e I l_ t o  I  e r an c e  by  -1  to 

o; 

do  i  *1  ton; 

l.bound  (i)  =  2 e ro^di s_ s t a t e  (i)  -  c en t e r_ce I  I _ t o I _ i nd 

ex; 

u  bound  (i)  =  ze r o_d i s« s t a t e  (i)  +  c en t e r _c e I l_ t o l_ i nd 
ex;  ~ 

end  ; 

r ecu r se_ I e ve  I  =  n; 
call  add_ c en t _ t c I _c ode ; 
end; 

free  dis_state/  zero _di s_st at e/  cont_state/  l_bound/  u_bou 

n  d  ; 


a dd_c e nt_ 1 0  I _c od e :  procedure  recursive; 

if  (  r ecu r se_  I  e ve I  <=  0  >  then 
do; 

call  convert.Sdi s_state_to_code  ( ( d i s_ s t at e ) ^  state_ 

code)  ; 

center_dist  (state_code)  »  c en t er_ c e I  I  t o  I  i ndex  ; 
end; 
else 
do; 

do  dis_state  ( r ec urse_ I e ve I )  =  I  bound  ( r e c urs e_ I  eve 

I  )  to 

unbound 

<  recurse_  level )  ; 

rec u r se_  I  eve  I  =  rec u r se^  I  eve  I  -  1; 
call  add.cen t_tol_code; 
end; 
end; 

recurse^l e vel  »  re curse.l eve  I  +  i; 
end  add^cent^tol.code; 
end  ini t ial ize_center^dist_array; 


find_root_cel  Is: 
_cel Intolerance# 


procedure  ( c e I l^s t a t us #  center_dist#  center 
cellnStatuSnindex); 


del  cell.status  <*)  fixed; 
del  center_dist  (*)  fixed; 
del  center_ cel  Intolerance  fixed; 
del  ce I InSt a tus n i nde X  fixed; 

del  n  fixed  external; 

del  nuninSta  t  enC  oirfcs  fixed  external; 

del  i  fixed; 

del  maXn,num  ce  I  I  s  fixed; 

del  numn.ceirSn'‘«achable  to  fixed; 

del  bestn^ootnCOoe  fixed; 

del  z e rOnSt a te  c cce  fixed; 

del  centernC  elT  toln  fixed; 

del  dis_ state  <T:n)  fixed  controlled; 

del  contnState  (1:n)  float  controlled; 

del  unmarkednC e  I  I  s  bit(1); 
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del  po s s i b I e_ro 0 t  bit(1); 

del  true  bit(1)  initial  ("Vb); 

del  false  bit(1)  initial  ("0"b); 

del  e onve r t_ Sco n t _s t a t e^t o_d i s. s t a t e  entry  ((*)  float/  (*) 
fixed); 

del  e onve rt _ Sd i s _st a t e_ t o_e ode  entry  ((*)  fixed/  fixed); 


allocate  dis^state/  cont_state; 
con testate  =  O; 

call  conver t .$c or t^s t a t e_ t o_d i s^s t a t e  ( ( c on t _s t a t e ) /  dis_s 
t  a  t  e  )  ; 

call  conver t_$d i s_st ate_to_code  ( ( d i s. s t a t e ) /  zero^state.c 
ode)  ; 

cellos tatus_index  =  3; 

cell_status  C re r c_s t a t encode )  =  ce I  I ^ s t a t us_  i  nde x ; 

call  adduce  I  I  r e ac h ab I e_ to  ( ze r o_s t a t e_c ode /  cell^status) 

call  check^for  unirar  ked^cel  Is  ( unma  r  k  ed_  c  e  I  I  s  /  cell_status 

)  ; 

do  center.c e 1 1_ to  l_i ndex  =  1  to  center_ce I l_tolerance 

while  ( unmark 

ed_cells  =  t  rue )  ; 

call  c hec k_ f o r^pos s i b I e_r 00 1  ( pos s i b  I  e_ roo t /  center^cell 
_tol_index/ 

cel  l.stat 

US/  center^dist); 

do  while  <  pos s ib I e_root  =  true  ); 
maximum  cells  *  O; 
do  1  =  T  to  num_state_combs; 

if  (cent er.di s t  (i)*  c ent er^c e I l_t o 1. i ndex  &  cellist 
atus  ( i ) a  0)  then 
do; 

call  f  i  nd_num_cel I s^r eachab I e_t o  ((i)/  (cell_sta 

t  u  s  )  / 

num.c e 1 1 s 

^ r eac hab I e_to) ; 

if  (  nuir^c  e  1 1  s_  re  ach  ab  I  e_  1 0  >  max_num_ce  1 1  s  )  th 
e  n 

do ; 

bes t_r oot^code  =  i; 

max_num_ce I  I s  =  num_c e 1 1 s_ r eac h ab I e_t o ; 
end  ; 

end  ; 

end; 

c e 1 1_ St  a t us_ i nde X  =  ce 1 1 _s t a t us_ i ndex  +  2; 
cell_statas  (best.root  code)  =  c e I l_s t a t us. i nde x  ; 
call  add.c e  1 1  s.r e ac h ab 1 e_t 0  (best.root.code/  cell.stat 

us); 

call  ch e c k_ f 0 r.po ss i b I e.roo t  ( pos s i b I e. r oot/  center.ee 
I l.to  l.i ndex/ 

cel l.stat 

US/  c enter _di St); 
end  ; 

call  c hec k_ f 0 r.unm a r ked.c e 1 1 s  ( unma r k ed_ c e L I S/  cell.stat 

us); 

end; 

call  c  hec  k.  f  or.untrar  k  ed.ee  1 1  s  (unmarked  cells/  cell  status 

)  ; 

if  (  unma rk e d.c e  1 1  s  =  false  )  then 
do ; 

put  edit  ("Tree  sucessfully  comp  I e t ed  ")  ( s k i p / x ( 8 ) / a  )  ; 
end; 
else 
do ; 

out  edit  ("Trees  Unsucessfully  completed") (skip/x(8)/a 
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) 


end 


free  dis.state#  ccnt.stateJ 


check_for  unmarkec  cells:  orocedure  (unmarked  cells/  cell 
status); 

del  unmar k ed_ c e  1 1 s  bit(1); 
del  cell^status  (*)  fixed; 

del  num_s t a t e_ c emb s  fixed  external; 

del  i  fixea; 

del  true  bit(1)  initial  (”1*'b); 
del  false  bit(1)  initial  (’'0”b); 


unmarked_eel Is  =  false; 

do  i  =  1  to  nurr_st  ate^combs  while  (  unma  r  k  e  d_ce  1 1  s  =  fals 

if  (  cell_status  (i)  =  0  )  then 
unmar k ed_c e  1 1 s  =  true; 

end; 

end  e hec k_f o r_unmar k ed^ce 1 1 s ; 


c hec k_ f or .00 s s i b I e^ r 00 t :  procedure  ( doss i b I e.root /  oos  roo 
t.code/ 

cell.status/  center.di 

St); 

del  pos.root.ccce  fixed; 
del  possi b le. root  bit(T); 
del  cell. status  (*)  fi»ed; 
del  center.dist  (*)  fixed; 

del  num.s t a t e. c emb s  fixed  external; 

del  i  fixed; 


del  true  bit(1)  initial  (*'1*’b); 
del  false  bit(1)  initial  (”0”b); 


po s s i b I e_ r oo t  =  false; 

do  i  =  1  to  num _s t a t e_c omb s  while  ( poss i b I e.root  =  false 

/ 

if  (  center.dist  (i)  =  pos_ r oo t _c ode  8  cell. status  (i) 
=  0  )  then 

D0ssible_rcct  =  true; 

end  ; 


end  c h ec k.f o r.po s si b I e. root ; 


f ind.num.cel ls_reachable.to:  procedure  (eell.code/  temp  ce 
ll.stat/  num. cells);  “ 

del  eell.code  fixed; 

del  temp. c e L I _ s ta t  (*)  fixed; 

del  num.celLs  fixed; 
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dcL  num_s t ate_ccmb s  fixed  external; 
del  i  fixed; 


t  emo^c  e  1 1  _  s  t  a  t  (cell^code)  =  9*?; 

call  add_cells_reachable_to  (cell_code/  temp_cell_stat); 
num^cells  =  0; 

do  1  =  1  to  nufr  state^combs; 

if  (  temp  cell  stat  (i)  ’  100  )  then  num  cells  =  num  c 
e  I  I  s  +  1  ; 

end; 

end  f i nd_nu m_c e I  I s_ r e ac hab I e_t o; 


a dd_c e 1 1 s_r e ac h a b le_ 1 0 ;  procedure  (root_coder  cell_status) 


del  root_code  fixed; 

del  cell_status  (*)  fixed; 

del  num_s t a t e_ c omb s  fixed  external; 
del  num_i n put _ccmb s  fixed  external; 

del  sat_edge  ( 1  :num_state_combs^  1 : num_ i nput^c ombs )  bit( 
1)  controlled 

external; 

del  ne X t_ s t a t e^ f i I e^p t r  pointer  external; 

del  state.code  fixed; 
dc-l  input^code  fixed; 
del  next^state.code  fixed; 
del  root.status.code  fixed; 

del  ne X t^s t at e^map  (1 : num^s t a t e_c ombs /  1 : num_ i nput. combs  )  fi 
xed  controlled  external; 

del  the_next_state  mapping  ( 1 : num_s t at e^c ombs^  1:num_ino 
ut^combs)  fixed  binarydS) 

unsigned  based  ( ne x t^s t a t e_ f i I e_p t r ) ; 

del  found^reac hab I e_to^cel I  bit(l); 
del  found^good. input  bit(1); 
del  true  bit<lT  initial  <”1”b>; 
del  false  bitCI)  initial  ("0’'b); 


roo t_st at u s_c ode  =  cell^status  (root^code); 
f ound^ r ea c hab  I e_t o_ce 1 1  =  true; 
do  while  (  f oura_reachable_to_cel I  =  true  )! 
f ound_r e ac h ab le_ t o_ce 1 1  =  false; 
do  state_code  =  1  to  num_state_combs; 

if  (  ceLl_status  ( s t at e_c ode ) =  0  I  cell_status  (stat 
e_code)=  2  )  then 
do; 

f ound_good_ i nput  *  false; 

do  input^code*  1  to  num_i nput_combs  while  (found 
_good_input=  false); 

if  (  sat_edge  (state.code#  inout_code)  =  false 

)  then 

do; 

nex t ^s t a t encode  =  nex t^st at e_map  (state_co 

de  ^  i npu  t  _code)  ; 

if  (  cell_status  (nex t_st at e_code)  =  root_ 

statu s_ code  I 
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status.code 


+  1 ; 


+ 


cell  status  C ne x t^ s t a t e_ c ode )  =  root. 

1  ) 

then  f oun d.goo d_ i nou t  =  true; 

end; 

end; 

if  (  found. good. i nout  =  true  )  then 
do; 

cell. status  (state. code)  =  r oo t. s t a t u s . c ode 

found. reachable. to. cell  =  true; 
end ; 


end ; 

end; 

end; 

end  ad  deceits. reachable. to; 


end  f  i  nd^root.. c  e  I  I  s  ; 


open.control_lau_fi le:  orocedure; 

del  num^sta t e. combs  fixed  external; 

del  job^name  character  (50)  varying  external; 
del  working..dir  character  (168)  external; 

del  c on t r o I _ I  aw. f i I e.p t r  pointer  external; 

del  i  fixed; 

del  code  fixed  binary  (35); 

del  control. law  (Itnum., state. combs)  fixed  based  (control. I 
aw.fi le.ptr); 

del  delete  entry  options  (variable); 

del  he  s.Sma  k  e.seg  entry  (char  (*)^  char  (*)/  char  (.*),  fix 
ed  bin  ( 5  )  / 

ptr»  fixed  bin  (35)); 

call  delete  ( j ob.nam e  I  I "« con t ro I . I  aw” ^  ”-bf"); 
call  hes  Smake.seg  ( wor k i ng.d i r ^  i  ob.name I  I ” . c on t ro I _  I  aw”# 
””#  QlOlOb#* 

control.law.f i le.pt r#  code); 

do  i  =  1  to  num. state  combs; 

control. law  (i)  *  07 
end; 

end  open.cont rol.  I  aw.f i le; 


f i nd_ I oops.and.c on t.l a w :  procedure  ( c e I  1. s t a t u s #  center. dist 

cel 

l.st atus. i ndex#  c en t e r.c e 1 1. 1 o I e r anc e #  f ound. a  I  I . I oo os ) ; 

del  cell. status  (*)  fixed; 
del  center. dist  (*)  fixed; 
del  c e I l.st a t us . i nde X  fixed; 
del  center. cell. tolerance  fixed; 

del  num. state. combs  fixed  external; 
del  num. i npu t.c ombs  fixed  external; 

del  sat. edge  ( 1  :  num. s t at e.co mbs #  1 : num. i n ou t . c omb s )  b  i  t  ( f  ) 
controlled 

externa  i; 
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del  ne X t _ St  a t f  i  le_p t r  pointer  external; 
del  c on t r 0 l_ I  a w _ f i I e_o t r  pointer  external; 

del  i  fixed; 

del  state_code  fixed; 

del  input.code  fixed;. 

del  next_st a te  code  fixed; 

del  root_code  fixed; 

del  r oo t_st a t u s _ c ede  fixed; 

del  min_centdist  fixed; 

del  be s t_ce I r_ t o_add  fixed; 

del  b e s t^con t r 0  I , inp u t  fixed; 

del  con t r 0 1^ I  a w_ 1 npu t  ( 1 : num_s t a t e_ combs )  fixed  controlled 


del  next_state_map  (1:num^state_combs/  1:num_input_combs)  fi 
xed  controTled  external; 

del  the_next^state  mapping  ( 1 : num_s t a t e_c omb 1:num_inp 
ut_combs)  fixed  binarydS) 

unsigned  based  (next_state_frle_ptr); 
del  control_law  < 1 : n um^s t at e_c ombs )  fixed  based  (control_l 
aw_f i le_pt  r ) ; 

del  f  ound_a  L  l_  I  oops  bitd); 
del  f ound_root_ccce  bitd); 
del  found^loop^  bitd); 
del  added^c  e  1 1^  t  o_t  r  ee  bitd); 
del  true  5itdT  initial  (’*1''b); 
del  false  bitd)  initial  (''Q”b); 


allocate  control.lau^input; 


f ound.al l.loops  =  true; 

do  root^status^cede  *  3  by  2  to  cel l_status_index 

while  ( f ound^a I 

l^  loops  =  t  rue) t 

f ound^roo t.code  =  false; 

do  i  s  1  to  nuir_st  ate_combs  while  ( f  ound_  r  oo  t_c  ode  =  fal 

se ) ; 

if  (  cell_status  <i)  =  root^status^code  )  then 
do; 

root  code  =  i; 
founder oot^code  *  true; 
end  ; 

end; 

con  t  r  o  l_l  a  w_  i  nput  =  O; 
founds  I  OOP  -  false; 

control^law_ input  (root^code)  =  9999; 
do  input^code  =  1  to  num^i nput_combs; 

ne X t_st a t e^ c ode  =  next_state_map  (root_code^  input.cod 

e )  ; 

if  <  ne X t_s t a te_ c ode  =  root^code  )  then 
do; 

found.locp  =  true; 

c on t r 0 1 _  I  aw_ i nput  (root^code)  =  input.code; 
end; 

end; 

added_cell_to_tree  =  true; 

do  while  <  founa_looo  =  false  S  added_c e I l_ t o_ t r ee  =  tru 

e  )  ; 

m i n_c en t _d i s t  =  c ent e r_ c e 1 1_ t o  I  e r anc e  +  i; 
do  state.code  =  1  to  num_state  combs; 

if  (  cell_status  (state_codeT  =  root.status  code  +  1 
S 

c on t r c  l_ I  a ta_ i npu t  (state_code)  =05 
center^dist  (state_code)  “=  0  )  then 
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)  then 


do; 

do  input_code  =  1  to  num_inDut_comhs; 

if  (  sat_edge  (state_code/  inout.code)  =  false 

do; 


de»  inDut_code); 
status_code  I 
_code  +  1  )  then 

)  "=  0  )  then 

<  mi n_cen t_d i st ) 

ext_state_code) ; 
e; 


nex t _st ate^code  =  nex t_st at e_maD  (state_co 
if  (  cell_status  ( n e x t_ s t a t e_ c od e )  =  root. 
celL_status  ( ne x t_s t a t e_c ode ) =  root_status 
do ; 

if  ( c on t ro l_ I aw_ i nou t  ( n e x t_ s t a t e_ c o d e 
do; 

if  (center_dist  ( ne x t_ s t a t e_ c ode ) 

then 
do ; 

mi n^cent_di St  =  center_dist  (n 

best. cel l_to_ add  =  state.code; 
bes t _c on t ro I _ i npu t  =  input. cod 

end; 

end; 

end ; 

end; 


end; 

end; 

end; 

if  (  min. cent. dist  <  center_cell_tolerance  +  1  )  then 
do; 

added.c e I l.t o.t ree  =  true; 

c  on  t  ro  I  _  I  aw.  i  nput  (  be  s  t.,ce  I  l.t  o.add  )  =  best.contro 

L. input ; 

do  input.code  *  1  to  num. i npu t.comb s ; 

next..state.code  =  ne  x  t.st  a  t  e.ma  p  (root.code/  inp 

u  t^c  ode ) ; 

if  (  next.state.code  =  bes t.c e I l.t o.add  )  then 
do; 

fourd.loop  =  true; 

c cntro  1. law. i nput  (root.code)  =  input.code; 
end  ; 


end  ; 
end; 
else 
do; 

added. cel l.t otree  =  false; 
found. loop  =  raise; 
end; 


end ; 

if  (  found  loop  »  true  )  then 
do; 

found. a  I  I _  loop s  «  true; 

control. law  (root.code)  =  control  law  input  (root.co 
de);  ■  ■ 

state  code=  ne x t.s t a t e.map  ( r oo t.c ode # c on t r o I . I  a w. i n 
out  ( root.code) T ; 

do  while  (  state. code  “=  root.code  ); 

control  law  (state  code)  =  control  law  inout  (stat 

e.code) ; 

state. cede  =  nex t.s t a t e.map  (state. code^  control.l 

a  w. i n  pu  t 


( s  t  at  e.c  ode ) ) ; 
end ; 
end; 
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else 

f ound_a I L_  I  ooos  =  false; 

end; 

if  (  f oun d_ a  1 1_  I  c cps  =  true  )  then 
do ; 

put  edit  ("Sucessfully  built  tolerant  region  control  I 
aw (skip/  x(4)/ 

a)  ; 
end ; 

else 

do; 

put  edit  ("Tclerant  region  control  law  cound  not  be  bu 
ilt’')(skip/  x(8)/ 

a)  ; 
end  ; 

free  c on t ro I _ I  a w_ i np u t  ; 
end  f i nd_ I  OOP s^an c_ con t_  I  aw; 


bu  i  ld_op  t  i  tna  l_  c  on  t  rc  l_  I  aw  :  procedure  (  c  e  I  l_s  t  a  t  us>  cell_stat 
us^ index) ; 

del  cell_status  (*)  fixed; 
del  ce 1 1_ St  a tus_ i nde X  fixed; 

del  nuni_stat  e^coirhs  fixed  external; 
del  num^  i  npu  t_c  otTibs  fixed  external; 

del  sat^edge  ( 1 ; num^ s t a t e_combs /  1 : num_i nput_combs)  bit(1) 
controlled 

ex  terna  I ; 

del  next_state_f i le_ptr  pointer  external; 
del  cont r oi_ law^ f i le_pt r  pointer  external; 

del  state^code  fixed; 
del  input^code  fixed; 
del  next_st a te_coCe  fixed; 
del  root_st a tus^cede  fixed; 

del  1  mi n_pa  t  h / 

2  cost  float/ 

2  sta_code  fixed/ 

2  i no_code  f i x  ed; 

del  control_law  (1:num_state_con)bs)  fixed  based  (control_l 
awfi le_ptr); 

del  next  state_map  (1 ; num_s t a t e_c ombs /  1 : num_ i nput _combs  )  fi 
xed  controlled  external; 

del  the.ne xt_st ate  mapping  (1 : num^s t a t e_c ombs/  1:num_ino 
ut^combs)  fixed  binary(l5) 

unsigned  based  ( nex t_s t a t e_ f i I e_p t r  )  ; 

del  cost  float; 

del  path_cost  ( 1 : rum _s t a t e_c ombs )  float  controlled; 

del  f  ound_c  e  I  l_tQ_add  bitd); 
del  true  bit(1)  initial  (”1”b); 
del  false  bit(1)  initial  ("0*'b); 

del  sysprint  file  output; 


allocate  path_cost; 
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put  edit  ("Buildinq  control  law'*)(skio#  x(4)a  a); 
pat  h_cost  =  O; 

do  root^status^code  =  3  by  2  to  cell.status.index/ 
f ound^cel l_to_acd  =  true; 
do  while  (  f ourc^c e I  I  to_add=  true  ); 
m 1 n_pat h . c 0 s t  =  1e38; 

do  state_C'Ode  =  1  to  num_  s  t  a  t  e_  c  omb  s  ; 

if  (  cell.status  (state_code)  =  r  oo  t_  s  t  a  t  us_c  o  de  1 


do; 


control_law  (state_code)  =  0  )  then 


)  then 


do  input_code  =  1  to  num_ i n pu t _ c om b s ; 

if  (  sat.edge  (state_code#  input.code)  =  false 


do; 


de/  i nput_code) ; 
status.code  I 
us.code  +  1)  then 

0  i 
hen 

nput.code); 
encode ) ; 


rex t _state_code  =  n e x t_ s t a t e.map  (state^co 
if  (  cell_status  ( ne x t_ s t a t e_c ode )  =  root_ 
cell.status  ( ne x t_ s t a t e_c o de ) s  root.stat 


do; 


if  (  control_lau  ( ne x t_ s t a t encode )  *= 
next_state_code  *=  state.code  )  t 


do; 


cost  =  compute.cost  (state^code/  i 

cost  =  cost  +  path_cost  (next_stat 

if  (  cost  <  m i n„pa t h . c os t )  then 
do; 

min^pat h. cost  *  cost; 
min^path. sta.code  -  state.code 

mi n^pat h, i np_code  *  input.code 

end; 


end; 

end; 

end; 

end; 
end  ; 

end; 

if  (  mi n^pa t h .CO s t  <  1e38  )  then 
do; 

f ou nd.c e  I  l_t o_add  =  true; 

control_lau  ( mi n_pa t h , s t a_c od e )  =  m i n_oat h. i no_cod 

oath_cost  ( m i n_pa t h . s t a^c od e )  =  m  in_oat h. cos t ; 
end; 
else 

f ound_ ce I l_ to_ add  =  false; 

end  ; 
end; 


free  pat  h_c  o  s t  ; 

comput e_cos t :  procedure  (state_code/  input.code)  returns  ( 
float); 


del  state_code  fixed; 
del  inout_code  fixed; 

del  n  fixed  external; 
del  p  fixed  external; 
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del  CO s t_ f un c t  i  cn_ c 0 de  fixed  external; 

del  state_cost_iTatrix  (1:n)  float  controlled  external; 
del  inout.cost.iratrix  <1:p)  float  controlled  external; 

del  i  fixed; 

del  dis.state  (1:n)  fixed  controlled; 
del  dis^inout  (1:p)  fixed  controlled; 

del  cost  float; 

del  cont_state  dm)  float  controlled; 
del  cont_input  d:p)  float  controlled; 

del  eonvert_Sccce_ to_dis_state  entry  (fixed^  (*)  fixed); 
del  conver t_Sccce_to_dis_inout  entry  (fixed/  (*)  fixed); 
del  conve r t_$d  i  s_s t at e_to_con t  state  entry  ((*)  fixed/  ( 
* )  float); 

^  del  conver t_$di s^i nput_to_cont_input  entry  ((★)  fixed/  ( 
* )  f I  oat )  ; 

del  custom.cost.funct ion  entry  ((*)  float/  (*)  float)  re 
turns  (float); 


goto  case  ( c oj t _f u nc t i on_c ode ) ; 

case  (1 ) :  cost  =  1; 

goto  do  re; 

case  (2):  allocate  dis^state#  dis_input/  cont  state/  cont 
input;  ~  “ 

call  convert_$code_to_dis_state  (( st at  encode) /  d 


i s^state ) I 
i s_i nput ) ; 


call  corve rt^$code_to^dis_i nput  ( ( inout^code )  /  d 


call  corvert^Sdis.state^to^cont  state  ((dis  stat 
e)  /  cont.state) ; 

^  call  conve rt^Sdi s_i nput.t 0. cont _ i nput  ((dis  inpu 

t)/  cont^input); 

cost  *  g; 
do  i  =1  ton; 

cost  =  cost  +  ((cont_state  (i)  ★*  2)  *  state  c 

ost_tiiatrix<i)); 

end; 

do  i  =1  top; 

cost  =  cost  +  ((cont  input  (i)  **  2)  *  input  c 
ost_matrix(i));  “ 

end; 

free  dis_state/  dis_inout/  cont_state/  cont_inou 
t  / 

goto  dene; 

case  (3):  allocate  dis^input/  cont_inout; 

call  conve rt_Scode_to^dis  input  ((input  code)/  d 

is^input); 

.  call  c 0 nve r t _$d i s_ i npu t_t o  cont  input  ((dis  inpu 

t)/cont_input); 

cost  =  g; 
doi  =1top; 

cost  =  cost  +  (input_cost  matrix  (i)  *  abs  (co 

n  t^i nput  ( i  )  )  )  ; 

end; 

free  dis^input/  cont_input; 
goto  done; 


case  (4):  allocate  dis_state/  dis_input/  cont  state/  cont 
input;  ~  ~ 

call  c onve r t_Sc ode.t o_di s  state  ((state  code)/  d 

is_state); 
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call  c 0 nv e r t_ $c od e_ t 0 _d i s_ i npu t  ( ( i n pu t _c o de ) #  d 

i s_ i nput )  ; 

call  c 0 rve r t _ Sdi s_s t a t e_ t o_ c on t _ s t a t e  ((dis_stat 
e)/  cont_state); 

call  c 0 nve r Sd i s_ i np u t _t o_ c on t _ i n pu t  ((dis.inpu 
t ) /  cont_ i nput ) I 

cost  =  cu s t Gm_c 0 s t _ f un c t i on  (cont.state#  contain 

put); 

dis  states  dis.input/  cont_state/  cont.inou 
t ; 

goto  dene; 

dene:  return  (cost); 

end  c ompu te _ c 0 s t ; 
end  build_optitnal_ccntrol_lau; 


pr 1 nt_ce I l_st a tus :  procedure  ( c e  1 1_ s t a t us ) ; 

del  cell_status  (*)  fixed; 

del  n  fixed  external; 

del  nutn  state_co(rbs  fixed  external; 

del  numbe r_o f _s t ecs_ s  (1:n)  fixed  controlled  external; 

del  i  fixed; 
del  i  fixed; 
del  k  fixed; 
del  I  fixed; 

del  yn_answer  ok  entry  (character  (3)  varying); 
del  sysprint  rile  output; 

^  put  edit  ("Would  you  like  the  cell  status  array  printed  ? 

(skip/  a ) ; 
get  list  (answer); 
call  yn^answer  ok  (answer); 
if  (answer  =  ^y"  I  answer  =  "yes"  )  then 
do ; 

if  (n=2  )  then 

do; 

k  =  o; 

put  skip  (2); 

do  i  =  1  to  number_of _steps_s  (2); 
out  skip; 

do  i  =  1  to  numbe r_of_steps  s  (1); 
k  =  k  +  i; 

put  ecit  (celt_status  (k))(f(5)); 
end; 
end  ; 
end; 
else 
do; 

if  (  n  =  3  )  then 
do ; 

I  =  c; 

do  i  =  1  to  numbe r_o f _ s t e os_ s  (3); 
put  skip  (2); 

do  j  =  1  to  number _of_steos'_s  (2); 
put  s  k i p  ; 

GC  k  =  1  to  number  of  steps  s  (1); 

I  =  I  +  1; 

out  edit  (cell_status  (l))(f(5)); 
end  ; 
end; 
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( 6 ) ) ; 


end  ; 
end; 
else 
do; 

do  1  =  1  to  num_state_combs; 

put  edit  (i^  cell_status  (i))(skior  f(36)#  f 

end ; 
e n d;  ■ 

end; 

end ; 

end  pr i nt_cel L^s t atus ; 


p r i n t_c on t ro l_l  a u :  procedure; 
del  i  fixed; 

del  num_sta te_combs  fixed  external; 

del  cont ro l_l aw_f i le_p t r  pointer  external; 

del  answer  character  (3)  varying; 

del  yn_answer^ok  entry  ( c ha rac te r ( 3 )  varying); 
del  sysin  file  input; 
del  sysout  file  output; 

del  control  law  ( 1  :  num^s t a t e^combs )  fixed  based  (control  law 
_file_ptr); 

put  edit  ("Would  you  like  the  control  law  printed'’  =>  ")(ski 

0  fa)  ; 

get  list  (answer); 
call  yn_answer^ok  (answer); 
if  (answer  =  "y"  I  answer  =  "yes”)  then 
callpr^contlaw; 
end  pr i nt_cont r oT.  I  aw; 

goto  endit; 
pr^cont.law:  entry; 

put  edit  ("  Control  Law:")(skip^  a); 
pu  t  s  k i p ; 

do  i  =  1  to  num_  s  tate:_cofflbs; 

put  edit  (i^  control^law  (i))(skip^  x(4)^  f(4)^  f(6) 

)  ; 

end; 

put  skip; 
return; 


endit:  put  skip; 

end  bu i I d_to l_r e g_and_con t_  I  aw; 
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s i mu  I  a t e_ s y s t em :  procedure; 

del  n  fixed  external; 
del  p  fixed  external; 
del  o_real  fixed  external; 

del  number^ of_steps_s  (1:n)  fixed  controlled  external; 
cel  numb  er^of  I  s  t  e  p  sli  dtp)  fixed  controlled  external; 
del  VO  1 1 age_u 0 pe r _ b oun d_ s  (1:n)  float  controlled  external; 
del  VO  1 1 age3 1  0  we r_boun d”s  (1:n)  float  controlled  external; 
del  voltage^upper^bcund^i  (1:o)  float  controlled  external; 
del  VO  1 1 agel I o we r _bcun d2 i  (1:p)  float  controlled  external; 
del  num_state_combs  fixed  external; 
del  num“sim_data  fixed  external; 

del  tau  float  external; 

del  1  s i mu  I  at i on^ 0  a t a  ( 1 : num_s i m^da t a )  controlled  external# 

2  time  float# 

2  con_state  (10)  float# 

2  con_input  < 1 : i nput^d i m)  float; 

del  1  flag  external# 

2  cont.exists  bit(1># 

2  di sc r ete  exi s t s  bit(1)# 

2  quan t i 2 ed.ex i St s  bit(1)# 

2  cont r 0  I  I aw^v a  I  i d  bit(l)# 

2  si valid  bit(1)# 

2  own'quan t _f i I e_e X i s t s  bit(1); 

del  true  bit(1)  initial  ("1*‘b); 
del  false  bit(1)  initial  ("0'*b); 
del  own_ cont_ sy s_ e X i s t s  bit(l); 

del  uncont rol I ab I e_ce I  I  ( 1  :  num^s t a t e_ c ombs  )  bit  (1)  controll 
ed  external; 

del  con t ro l.l a w_f i I e.p t r  pointer  external; 

del  i  fixed; 
del  j  fixed; 

del  answer  character  (3)  varying; 

del  save^it  character  (3)  varying; 

del  choice  ch a r ac t e r < 1  )  ; 

del  choice  value  fixed; 

dc  I  range  fixed; 

del  ma x^ num_s t ep s  fixed; 

del  num”step  fixed; 

del  num^recurse  levels  fixed; 

dc  I  reg ion  fixed; 

del  matrix  dim  fixed  binary  (35); 

del  input^dim  fixec  external; 

del  ind  fixed  binary  (35); 

del  ier  fixed  binary  (35); 

del  state_code  fixed; 

del  input^code  fixed; 

del  temp^state  code  fixed; 

del  dis.state  Tl:n)  fixed  controlled; 

del  dis^input  (1:o)  fixed  controlled; 

del  t emp^d i s  s t a t e  (1:n)  fixed  controlled; 

del  control_raw  ( 1  :num_state_combs)  fixed  based  (control_law 
_file_otr);” 

del  time  float  binary; 

del  time^init  float; 

del  time_final  float; 

del  step  float; 

del  step^end  float  binary; 

del  tolerance  float  binary; 

del  seal  e_ factor  float; 
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dcL  c  (1:24)  float  binary; 

del  cont^state  (1G)  float  binary; 

del  St  a t e_t emp ( 1 0  )  float  binary; 

del  input^to.use  ( 1  :  i nput^dim)  float  controlled  external; 
del  cont^input  ( 1 : i nou t _d i m )  float  controlled  external^ 
del  t emo_ cont ^ s t a t e  (10)  float  binary; 
del  w  ( 1 : ma t r 1 x_d  i  w /  1:9)  float  binary  controlled; 

del  orint_data  character  (3)  varying; 

del  sy s t em^un s t a b  I  e  bit  <1); 

del  convert^Scont^stat e_to_di s_state  entry  ((*)  floats  <*)  f 
i xed)  ; 

del  c onv e r t_$ d i s_ s t a t e , t 0^ c ode  entry  ((*)  fixed^  fixed); 
del  convert_Scode-^to_d  1  s^Tnout  entry  (fixed#  (*)  fixed); 
del  con V er t^Sd i 1  npu t  to^cont  input  entry  ((*)  fixed#  (*)  f 
loat )  ; 

del  choose^your  plot  entry; 

del  yn_answer_0K  entry  ( cnarac t e r ( 3)  varying); 

del  num_ ansue r^o k  entry  (character  (1)#  fixed#  fixed); 

del  own_sys_to  situ  entry  (fixed  binary(35)#  float  binary#  fl 
oat  binary#  (*)  float  binary^  (*)  float  binary#  float  binary# 
float  binary); 


del  imslSdverk  entry  (fixed  binary  (35)#  entry#  float  binary 
#  (*)  float 

binary#  float  binary#  float  binary#  fi 

xedbinary(35)# 

(*)  float  binary#  fixed  binary  (35)#  ( 

*#  *)  float 

binary#  fixed  binary  (35)); 


del  s i m^cont. f i I e  file; 
del  si m^dat a  f i I e  file; 
del  sysin  file  input# 
del  sysprint  file  output; 

de I  mod  bui It i n; 

if  ( f I ag» eont r 0 1_  I  a w_v a  I i d  =  false)  then  do; 

put  edit  ("A  control  law  does  not  exist  for  this  iob")(ski 
p  #  a3  ; 

goto  done; 
end  ; 

if  (flag.simvalid  =  false)  then  do; 

put  edit(”Would  you  like  to  simulate  the  system?  =>  '’)(sk 
i  p#a ) ; 

get  list  (answer); 
call  yn^answer^ok  (answer); 
if  (answer  =  ”n”  I  answer  =  ”no'*)  then 
goto  done; 

end; 

else  do; 

put  edit  ("  Would  you  like  to  :  ”)(skip#a); 
out  skip; 

out  edit  (”1.  Modify  the  simulated  data  f i I e”) ( sk i p# a) ; 
out  edit  ("2.  Plot  your  existing  simulated  data”) ( s k  io#a 

)  ; 

put  edit  ("3-  Quit")(skip#a); 
put  skip; 

put  edit  ("Please  choose  one  =>  ")(skip#a); 
get  list  (choice); 
ranqe  =  3; 

call  num_a n swe r_c k  (choice#  range#  c h oi c e_ v a  I ue ) ; 
if  ( choi ce_va lue  =  1)  then 
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f I ag . s i m_va  I  i d  =  false; 
if  ( c ho i ce_ va I u e  =  2)  then 
do; 

call  c hoo s e_y our_p lo t ; 
goto  done; 
end; 

if  ( c ho i ce_ va I ue  =  3)  then 
goto  done; 

end ; 

if  ( f I ag. quan t i z ed_eK i s t s  »  false)  then  do) 

put  edit  ("The  parameters  for  the  continuous  system  are  ne 
eded") ( sk i p^a ) ; 

put  edit  ("The  system  can  not  be  simulated") (skip#a); 
goto  done; 

end; 


if  (  f I ag . cont_e X i s t s  =  true)  then  do; 
put  edit  ("Would  you  like  to  simulate:  ")(skio#a); 
put  edit  ("  1.  The  continuous  system  in  the  job  file")( 

s  k i a ) ; 

put  edit  ("  2»  A  continuous  system  in  another  file")(sk 

i  0  /  a  )  ; 

put  skip; 

put  edit  ("Please  choose  one  =>  ")(skip^a); 

get  Li st  (choi ce)  ; 
range  =  2; 

call  nuffl_answer_ok  (choice#  range#  choice  value); 
end; 

else  choice_value  =  2; 

if  ( cho i ce.va I ue  ~  2)  then  do; 
own^cont^sy s_ex  i  sts  *  true) 

out  edit  (Enter  the  number  of  states  =>  ")(skip#a); 
get  list  (m a t r i x_di m ) ; 

put  edit  ("Enter  the  number  of  inputs  ®>  ")(skiD#a); 
get  list  (input^dim); 
end ; 

if  (choi ce_va  I  ue  »  1)  then  do; 
own_c ont^sy s_ex i sts  =  false; 
matrix  dim  =  n; 
input _Bim  »  p; 
end; 

if  (tau  =  0)  thendo; 

put  edit  ("Please  enter  tau  *>  ")(skio#a); 

get  list  (tau); 
end  ; 

allocate  dis_state#  dis^input#  t emp_d i s_ s t a t e #  cont^input#  in 
out_to_use; 

put  edit  ("Enter  number  of  steps  per  time  constant  =>  ")(sk 
ip#  a )  ; 

get  list  ( ma X _ num_ s t ep s )  ; 

put  edit  ("Enter  the  number  of  recursion  levels  =>  ")(skio# 

a ) ; 

get  list  (num^ rec u r se_ I  eve  I s ) ; 

if  ( num  r ecur s e_ I e ve I s  “»  0)  then  do; 

put  edit  ("Enter  the  scaling  factor  =>  ")(skio#  a); 
get  list  ( s c a  I e_ f ac t or ) ; 
end  ; 
else 

scale_factor  =  1e-20; 

put  edit  ("Enter  initial  st at e") ( s k i p#  a); 
put  skip; 

do  i  =  1  to  matrix_aim; 
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put  edit  ("initial  state  "#i/"  =>  ")(x(4)/  a/  f(3)#  a); 
get  list  (cont_state  (i)); 
state.temp  (i)  =  cont_state  (i); 
end ; 

put  edit  ("Enter  initial  time  =>  ")(skip^  a); 
get  list  (time.init); 

put  edit  ("Enter  final  time  *>  ")(skip#  a); 
get  list  (time_final); 

put  edit  ("Would  you  like  the  simulation  printed  while  runni 
ng  =>  ")(skiD/  a)? 

get  list  ( D r i n t_d a ta ) ; 

call  yn_answer_ok  ( pr i n t^da t a ) ; 

put  s K i p ; 

put  edit  ("  Simulating  system") ( sk i p#  x(2)/  a); 
if  (  print, data  =  "y"  I  pnnt^data  =  "yes"  )  then 

put  edit  ( " t i me " / "s t a t e "i npu t ") ( s k i p ( 2 ) /  x(3)^  a/x(12)/ 
a,  X ( 1 0 ) /  a )  ; 
put  skip; 
time  =  t  ime  i  n  i  t  ;■ 
step  =  tau  7  max_nufr  steps; 

nuffl_sim_data  =  ceil  ((time, final  -  time,init)  /  step); 
if  7 ( num,s i m,da ta  +  1)  *  step  <=  time, final)  then 
num^sim,data  =  num_sim_data  +  i; 

allocate  s i mu  I  at i on,da t a; 


num^step  =  O; 
ind  *  1  ; 

tolerance  *  «0001  I 
system^unstab le  -  false; 

do  i  s  1  to  num,s  i  ir,da  t  a  while  (  system,unstab  le  =  false  ); 
d  0  j  =  1  t  o  n ; 

it  (  cont, state  (j)  <  vo 1 1 age^ I  owe r_bound, s  (])  I 

cont_state  (j)  >  vol tage^upper, bound, s  ())  )  then 
system,unst ab  le  *  true; 

end; 

if  C  system, unstable  *  false  )  then 
do  ; 

call  convert_Scont_state,to,dis, state  ( ( cont_st a t e ) #  d 
i s,state ) ; 

call  conver t,Sdi s, state, to_code  ((dis  state)^  state  co 

de); 

if  (  un c ont r c I  la b I e,cel I  (state, code)  =  false  )  then 
do  ; 

if  (num,steD  =  0)  then 
do; 

call  find, region  (cont_state^  num_recurse_leve 
Is^  s ca I e, f ac to r ^ 


region) 
*  region); 
nt_state/ 


t emo,con t,s t a t e  =  cont, state  /  ( scale_f ac tor  * 
call  con ver t,Scont_ s t a t e, t o,di s_ s t a t e  (temo,co 


t  emp,di s.state) 

e  / 


call  con ve r t,Sd i s_s t a t e_ t o,c ode  ( t emo,di s_ s t a t 


emp_state,code) ; 

input, code  =  control, law  ( t emo, s t a t e, code ) ; 
call  cony ert,Scode_to,d i s_i nput  ( ( i npu t, c ode ) # 

di s, i nput ) ; 

call  con y e r t,Sd i s, i nou t, t o,c 0 n t _ i nou t  ((dis_in 
out)/cont, input) ; 


ion); 


cont_input  =  cont_input  *  ( s c a  I e,f ac t or  **  reg 
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end; 


simulat ion. data 

(  i  ) . t i me 

=  time; 

simulat ier. data 

( i ) . c  0  n. 

state 

(  *) 

=  cont. state 

(  *  ) 

simulaticr.data 

( i ) . c  on. 

input 

(★) 

=  cont.input 

(*) 

State. temp# 


state. temp# 
i  er)  ; 


if  <  print.data  =  ”y**  I  print  data  =  "yes”  )  then 
do; 

put  edit  < t i me ) ( s k i p #  f(8/3)); 
put  edit  ("  ’*>(a); 

do  j  =  1  to  matrix.dim; 

put  edit  (cont.state  C j )  )  ( f ( 1 4 # 3  )  )  ; 
end  ; 

put  edit  (**  *')(a); 
do  j  =  1  to  input  dim; 

put  edit  (cont.Tnput  (i))(f(14/3)); 
end  ; 
end; 

step. end  =  time  +  step; 

if  < oun_cont.sys.ex i St s  =  true)  then  do; 
input. to. use  =  cont. input; 

call  our.s ys.to.si m  (matrix  dim#  time#  step  end# 
cont. state#  time.init#  time  7inal); 
end; 

else  do ; 

allocate  w; 

call  imslSdverk  (matrix. dim#  cont  system#  time# 
step. end# 

tolerance#  ind#  c#  matrix  dim#  u# 


cont. state 
free  w ; 
if  ( i n c  <  i 
put  edit 
put  eait 
out  list 
put  edit 
put  list 
end; 
end  ; 
end; 
e  I  se 


=  state.temp; 

I  I  ier  >  0)  then  do; 

('•ERROR  using  I M  SL”)  (  s  k  i  p  #a  > 
(•*ind  =  ’•)(skio#a); 

(ind); 

("ier  »  ")(skio#a); 

(ier); 


syst em. unstable  =  true; 

end; 

num  step  =  num.step  +  i; 
if  (num.step  *  trax.num.steos )  then 
num.step  »  O; 

end; 

if  (system.unstab  le  =  true  )  then 
do; 

put  edit  ("The  system  has  gone  un s t ab I e " ) ( s k i p ( 2 ) 
call  build. si m. data. file; 
call  choose  your  plot; 

end; 

else 

do; 

call  bu i L d. s i m.oa t a. f i  I  e; 
call  choose. your  plot; 
end; 


a  ) ; 


free  dis. state#  dis.input#  t emp.d i s .s t a t e#  cont. input#  s i mu  I 
ation.data#  i np u t. t o.use ; 

done;  put  skip  (2); 

find. region  :  orocedure  (cont. state#  num. r e c ur s e. I  eve  I s #  sea 
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le^factor/ 

r egi on)  ; 

del  cont.state  (*)  float; 
del  numrecupse_levels  fixed; 
del  scale.faetor  float; 
del  region  fixed; 

del  n  fixed  external; 


del  VO  1 1 age^ UDp e r_bound_s  (1:n)  float  controlled  external; 
del  VO  1 1 age^ I  owe r_bound_s  (1:n)  float  controlled  external; 


del  i  fixed; 
del  j  fixed; 


region  =  num^recurse  levels; 
i f ' ( nuffl_ r ecur s e_ I  eve  I s  “=  0)  then  do; 
do  i  =  1  to  n;  ■ 

if  <  cont  state  Ci)  >=  0  )  then 
do; 

do  j  =  1  to  nuui_recurse_level  s  while  ( 

)  < 

<  voltage. uoper_bound_s 

factor  **  j  ))); 

end; 

end; 

else 
do  ; 

do  i  =  1  to  num. recurse. I evel s  while  ( 

)  > 

(  vo Itage.l owe r.bound. s 

factor  **  j  ))); 

end; 

end; 

if  (  j-1  <  region  )  then 
region  =  j-l; 

end; 

end; 


c  on  t.s  t  a  t  e  ( i 
(i)  *  (scale. 


cont. state  (i 
(i)  *  (scale. 


end  find.region; 

cont.system:  procedure  (matrix.dim^  time#  state.temp#  state, 
t  emp.pri me ) ; 

del  matrix.dim  fixed  binary  (35); 

del  time  float  binary; 

del  state.temp  (1C)  float  binary; 

del  St  ate. t emp. prime  (10)  float  binary; 

del  n  fixed  external; 
del  p  fixed  external; 

del  cont. input  dtp)  float'  controlled  external; 
del  a.matrix  (Izn#  1  :n)  float  controlled  external; 
del  b.matrix  (1;n#  1:o)  float  controlled  external; 

del  i  fixed; 
del  j  fixed; 


X 


do  i  =  1  to  n; 

s t a t e.t emp.pr i me  (i)  = 
dojsiton; 

s t at e.t e mp.p r  ime  (i) 
(i#  j)  * 


o; 


=  state.temp.pr i me 
state.temp  (j)); 


(i)  +  (a.matri 
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end; 

end; 

do  i  =  1  to  n; 
do  j  =1  to  D-; 

state_temp_ prime  (i) 
X  ( i  /  j )  * 

end ; 
end; 


s t a t e_ t emp_pr i me  (i)  +  (b^matri 
cont_i nput  ( j ) ) ; 


end  cont_system; 

b u i I d_s i m_ da t a_ f i I e  :  procedure; 

del  n  fixed  external; 
del  p  f i xed  external; 
del  num^sim_data  fixed  external; 


del  1  s i mulat i on_data  (1 : num^s i m_da t a )  controlled  external# 
2  time  float# 

2  con_state  (1:n)  float# 

2  con_inout  dtp)  float; 

del  true  bit(1)  initial  (**1’*b); 
del  false  bit(1)  initial  (’*0**b>; 
del  1  flag  external# 

2  cont_exi'8ts  bit(1)# 

2  di sc rete  exi s ts  bit(1)# 

2  quant i 2ed_exi Sts  bit(1)# 

2  cont r o l^ I aw,v a  I i d  bit(l)# 

2  sim^valid  bit(1)# 

2  oun^quan  t«  f  i  I  e^ex  i  St  s  bitd); 

del  job^name  character  (50)  varying  external; 

del  w i d t h^s i m_ma t  fixed; 

del  sim  data.matrix  ( 1 :num^s i m_dat a#  1 ; w i dt h^s i m^ma t >  float 
controlleH  external; 

del  answer  character  (3)  varying; 
del  i  fixed; 
del  i  f i xed; 
del  X  fixed; 


del  yn_answer  ok  entry  ( c hara c t er ( 3 )  varying); 
del  s i m^da t a  T i le  f i I e ; 
del  sysin  file  input; 
del  sysprint  file  output; 

u  i  d  t  h^s  i  m^mat  =  n  p  +  1 ; 
allocate  sim_data_matrix; 

s  i  m  dat a_ma t r i X  (*#1)  »  s i mu  I  a t i on_d a t a  (*).rime; 
do  ]  »  2  to  (n+1); 

sim  data  matrix  (*#j)  =  s i mu  I  a t i on_da t a  ( * ) . con_ s t a t e 

(j-1); 

end  ; 

do  k  =  (n+2)  to  (n+o*!); 

sim  data  matrix  (*#k)  »  s i mu  I  at i on_dat a  (  *  )  . con_ i nou t 

(k-n-1); 

end ; 

put  edit  ("Would  you  like  to  save  the  simulated  data  in  a  fi 
le?  =>  ") (skip#a) ; 
get  list  (answer); 
call  yn_answer_ok  (answer); 
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if  (answers  *'y"  I  answer  s  ”yes**)  then  do! 

open  file  (  s  i  tn^da  t  a_f  i  I  e )  title  ("vfile_  '*  I  1  j  ob_name  I  I 

''_ts,plot")  stream  output; 


do  i  =  1  to  num_sim  data; 

do  i  =  1  to  widtn_sim^mat; 

put  file  (  s  i  rr_da  t  a_  f  i  le  )  list  (  s  i  m_da  t  a_  ma  t  r  i  x  (i^j)); 
end; 
end ; 

free  s i m_data_mat r i x; 
f I ag- s i m_va I i d  =  true; 
end; 

close  f i le(si m_data_f i  le)  ; 
end  bui I d_si m_da t a_ f  i  le ; 
end  s i mu  I  a t e_sy s t em ; 
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c h 00 s e.y 0 u r_p I o t :  procedure; 

del  n  fixed  external; 
del  0  fixed  external; 
del  num_sim_data  fixed  external; 

del  job^name  charaeter  (50)  varying  external; 

del  true  bit(1)  initial  ("Vb); 
del  false  bit(1)  initial  ('*0”b); 
del  1  flag  external# 

2  eont_exists  bit(l)# 

2  discreteexists  bit(l)# 

2  quan t i red.ex i sts  bit(1)/ 

2  cont r 0  I au^v a  I i d  bit(1)# 

2  sim_valic  bitd)# 

2  oun_quant_file_ exists  bit(l); 

del  s  i  m  dat  a_fn  a  t  r  i  X  ( 1  :nuir_s  i  m_dat  a#  Itwidth  sim  mat)  float 
controlled  external;  ”  “ 

del  range  fixed; 

del  y_axis_choice  fixed; 

del  y_axis_c  characterd); 

del  x_a X i s^cho i ee  fixed; 

del  x^axis^c  eharacterd); 

del  widths sim_mat  fixed; 

del  number_of_plot s  fixed; 

del  answer  charaeter(3)  varying; 

del  plot^x  fix  ed; 
del  plot^y  fixed; 

del  x^array  <  1  :nuiTiber_of_plots#  1:num_sim  data)  float  contro 
1 1  ed; 

del  y. array  (1  :  nuirfc  er_o  f_p  lo  t  s  #  1  :  num_  s  i  m_d  a  t  a  )  float  contro 
lied; 


del  i  fixed; 
del  i  fixed; 
del  I  fixed; 

del  plot^data  character  (3)  varying; 

del  sim^datafile  file; 
del  sysin  file  input; 
del  sysprint  file  output; 

del  num_ansue r_Qk  entry  (ehar acter ( 1 ) #  fixed#  fixed); 
del  yn_ansuer_ok  entry  (eharacter ( 3)  varying); 

width_siffl_mat  =  n  +  p  +  i; 

put  edit  ("Would  you  like  to  plot  the  simulated  data?  =>  ") 
(skip#  a  )  ; 

get  list  (plot_data); 

call  yn_ansuer_ok  (plot  data); 

if  (plot.data  =  "yes"  I  plot.data  =  "y”)  then  do; 
if  ( f I ag . s i m_v a  I  id  =  true)  then  do; 
allocate  s  i  m^dat  a_i»a  t  r  i  x  ; 

open  file  < s  i  m^d a t a_f i I e )  title  ("vfile  "lljob  namell 
”_ts.olot  )  stream  input; 

do  i  *  1  to  num_sim  data; 

do  j  =  1  to  u  i  dt T5^s i  m_ma t ; 

get  file  ( s i m_dat a_f i I e )  list  (sim  data  matrix  ( 
1  #  ] )  )  ;  ~  ■ 
end; 
end; 
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end; 

end; 


do  while  C  plot_data  =  "yes’*  I  plot_data  =  "y"  )i 
i^  (  plot.data  =  "yes”  I  plot.data  =  "y"  )  then 
do  ; 

put  edit  ("yould  you  like  multiple  plots  on  one  graph?  " 
)(skip^  a); 

get  list  (answer); 
call  yn_3nswer_Qk  (answer); 
if  (answer  =  "y"  I  answer  =  "yes")  then 
do  ; 

put  edit  ("How  many  plots  would  you  like  to  put  on  t 
he  graph?  =>  "Mskip^a); 

get  list  ( numb e r_o f _p I o t s ) ; 
end ; 
else 

numbe  r.  o  f_p  1 0 1  s  =  i; 

at loc  ate  x^arr  ay; 
allocate  y_array; 


do  I  *  1  to  number_Qf_plots; 

if  (number_of^p  lots  >  1)  then 

out  edit  ("PLOT  I#  ":")(skip,  a#  x(1)^  f(1)/  x( 

1)«  a); 

put  edit("What  would  you  like  to  plot  on  the  y  axis? 
") (skip^a) ; 

out  edit("1.  A  s t a te" ) ( sk i o# a ) ; 
put  edit("2.  An  i nput ") ( s k i pr a ) ; 
put  edit("3.  Time") (skip^a); 
put  skip; 

put  edit  ("Please  choose  one  *>  ")(skipra); 
g-et  list  ( y.ax i  s.c  )  ; 
range  =  3; 

call  num^answer _ok  (y_axis«cr  range/  y^a x i s.choi c e )  ; 

if  (y^axis^choice  =  1)  then 
do« 

if  (n  a  1)  then 
plct.y  =  1; 
else 
do; 

put  edit<’*Which  state  do  you  wish  to  plot 
on  the  y  axis?  ")<skip/a); 

get  list  (plot_y); 
end; 

p lot_y  a  p lot_y  +  1 ; 
end  ; 

if  (y_axis_choice  =  2)  then 
do; 

if  (q  a  1)  then 
plct^y  =  1; 

else 

do; 

put  edit("Which  input  do  you  wish  to  plot 
ontheyaxis?")(skip/a); 

cet  list  (plot^y); 
end  J 

olot^y  a  plot_y  +  n  +  l; 
end  ; 

if  ( y_a x i s_ch 0 i c e  =  3)  then 
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p  I  0 y  =  1  J 

put  edit  ("What  would  you  like  to  plot  on  the  x  axis? 
"  )  (  s  k  i  p  #  a )  ; 

put  edit("1.  A  state '')<skip^a)J 
put  edit('*2.  An  i  npu  t " )  (  s  k  i  p  #  a  )  »’ 
put  edit  ("3.  T  i  me'* )  (  s  k  i  p^  a  ) ; 
put  skip; 

put  edit  ("Please  choose  one  =>  )(skip#a); 
get  list  (x^axi s_c )  ; 

call  num^ansuer^ok  (x^axis_c/  range/  x _ a x  i  s_ c h o  i  c e  )  ; 

if  ( x_a X i s_choi ce  =  1  )  then 
doT 

if(n  =  1)  then 
piot.x  =  i; 
else 
do; 

put  editC'Which  state  do  you  wish  to  plot 
on  the  x_axis  =>  **)(skip/a); 

get  list  (olot_x); 

end; 

piot^x  =  piot.x  +  i; 
end; 

if  (x  axis  choice  *  2)  then 
doT 

if  (p  »  1)  then 
p  lot.x  si; 
else 
do; 

put  edit(’*Which  input  do  you  wish  to  plot 
on  the  X  axis?")<skip/a); 

get  list  (olot_x); 
end ; 

plot.x  »  plot.x  +  n  +  i; 
end ; 

if  ( X _ax  i  s_ch 0 i ce  *  3)  then 

p I ot«  X  =  1  ; 


x_array(l^*)  *  s  i  m^dat a_ma t r i x ( */  olot.x); 
y_array  (I/*)  =  si m_dat a^mat ri x ( */  plot_y); 

end;  /*  do  loop  */ 

call  plot^the^sim  (x^array/  y.array/  n u mb er _o f _ p I o t s ) 

free  x_array; 
free  array; 
put  skip  (3); 

put  edit  ("Would  you  like  to  plot  the  simulated  data? 
=>")(skip»a); 

get  list  (plct.data); 

call  yn_answer_ok  (plot.data); 

end ; 

end;  /*  while 

close  file  ( s i m_d a t a_f  i  I  e )  ; 


p I  0 1_ t he_s i m :  procedure  (x_array/  y_array/  nu mbe r _of _p I o t s ) ; 
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del  x_array  (*/*)  float  parameter; 
del  yZarray  (*/*)  float  parameter; 
del  number_of_p lo t s  fixed  parameter; 

del  num^sim_data  fixed  external; 

del  X ( 1 ; num.s i m_d a t a )  float  controlled  external; 
del  y ( 1 ; nu m_s i m_d a t a )  float  controlled  external; 

del  vec.su  fixed  bir; 

del  symbol  (1  :  number_o  f_plots )  characterd)  controlled; 
del  symbol_mark  c bar ac t e r  ( 1  )  ; 
del  l_char”cha rac ter ( 1  )  ; 

del  scale^auto  bit<1); 

del  true  bitCI)  initial  <"1*'b); 

del  false  bit(i>  initial  <'*0"b); 

del  xmin  float  bin; 

del  xmax  float  bin; 

del  ymin  float  bin; 

del  ymax  float  bin; 

del  I  fixed; 

del  answer  character  <3)  varying; 

del  graphtitle  character  (25); 

del  xlabeT  character  (25); 

del  ylabel  character  (25); 

del  graph  type  fixes  bin; 

del  base  float  bin; 

del  grid.su_char  character  (1); 

del  grid^sw  fixed  bin; 

del  eq_scale_sw  fixed  bin; 

del  sysin  file  input; 
del  sysprint  file  output; 

del  num^an swe r_ok  entry  ( char ac ter ( 1 ) ^  fixed^  fixed); 
del  yn_answer_ok  entry  <character(3)  varying); 
del  plot^  entry  (<*)  float  bin^  <*)  float  bin#  fixed  bin#  fi 
xedbin#  charCI);; 

del  plot^Sscale  entry  (float  bin#  float  bin#  float  bin#  floa 
t  bin); 

del  plot_$setup  entry  (char(*)#  char(*)#  char(*)#  fixed  bin# 
float  bin#  fixed  bin#  fixed  bin); 


graph^title  *  "  "; 

X  label  =  '• 
ylabel  *  "  "  ; 

sea le_auto  =  true; 
graph^type  =  1 ; 
base  =  O; 
grid^sw  =  O; 
eq_scale_sw  =  O; 

a  I  locate  symbo  I ; 
symbol  =  '*  +  '•; 

put  edit  ("Would  ycu  like  a  symbol  to  represent  each  data  po 
int?  =>  ") (skio#a); 
get  list  (answer); 
call  yn_answer_ok  (answer); 
if  (answer  =  "y"  I  answer  *  "yes”)  then 
do; 

do  l  =  1  to  number  of.plots; 

if  (number_of  plots  <  2  )  then  do; 

put  edit  ("Enter  the  desired  symbol  =>  ")(skip# 
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get  list  (symbol(l)); 
end; 

else  do; 

out  edit  ("Fnter  the  desired  symbol  for  Plot  "/I 
a>  «)  (Skip^  a,  f  (1  )#  a); 

get  list  (symbol(l)); 
end; 
end; 

out  edit  ("Would  you  like  the  symbols  to  be  connected 
by  vectors?  =>  ")(skic^a); 

get  list  (answer); 
call  yn_ansuer_ok  (answer); 
if  (answer  =  "y"  I  answer  =  "yes"  )  then 
vec_sw  =  2; 
else 

vec. s  w  =  3  ; 

end  ; 
else 

vec_  sw  =  1  ; 


put  edit  ("The  graph  will  have  tick  marks#  be  automati 
cally  scaled#"  )(skip#a); 

put  edit  ("  and  have  no  labels  ")(skip#a); 
put  edit  ("Would  you  like  to  change  any  of  these  defau 
It  options'*  =>  ")(skic#a); 

get  list  (answer); 
call  yn_ansuer_ok  (answer); 
if  (answer  =  "y"  I  answer  »  "yes")  then 
do; 

put  edit  ("Would  you  like:  ")(skio#a); 
put  skip; 

put  ecit  ("1«  Tick  marks  and  values ")(skip#a); 
put  edit  ("2-  Dotted  grid  and  values ")(skio#a); 
put  edit  ( "3,  Solid  grid  and  v a  I u es")  (  s k i o# a )  ; 
pu  t  s  k  i  p; 

put  eoit  ("Please  choose  one  =>  ")(skip#a); 
get  list  ( g ri d_sw^c h a r ) ; 
range  =  3; 

call  num^a nsuer_ok  (grid^sw  char#  range#  grid_sw 

)  ; 

grid^sw  =  grid_sw  -  i; 


put  edit  ("Would  you  like  to  enter  a  title  and  a 
xis  labels  for  your  plot?  »>  ")(skip#  a); 
get  list  (answer); 
call  yn_ansuer_ok  (answer); 
if  (answer  =  "y"  I  answer  a  "yes")  then 
do  ; 

put  edit  ("Enter  the  desired  title  for  you 

r  olot")(skip#a); 

put  skip; 

get  I i St (gr aph^t i 1 1 e )  ; 

put  edit  ("Enter  the  label  for  the  x-axis" 

) ( s k i p# a )  ; 

put  skip; 

get  list(xlabel); 

put  edit  ("Enter  the  label  for  the  y-axis" 

) ( sk i o#a) ; 

putskip; 
get  I i St (yl abel  )  ; 
eno  ; 

put  ecit  ("Would  you  like  to  set  the  scale  of  th 
e  graph?  =>  ")(skip#a); 

get  list  (answer); 
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call  yn_answer_ok  (answer); 
if  (answer  =  **y**  I  answer  *  "y^s")  then 
do; 


scale_auto  a  fal 

se; 

put 

edit 

(••Enter 

the 

lower 

bound 

0  f 

the 

axis 

=  > 

'• )  (  s  k  i  p  *  a  )  ; 

get 

list 

( xm i n >  ; 

put 

edi  t 

(••Enter 

the 

upper 

bound 

o  f 

the 

axis 

=  > 

")(skip*a); 

get 

list 

( xmax ) ; 

put 

edit 

(••Enter 

the 

lower 

bound 

of 

the 

axis 

a> 

'• )  <  s  k  i  p  *  a  )  ; 

get 

list 

(ymi n) ; 
(*Enter 

of 

the 

put 

edit 

the 

upper 

bound 

axis 

=  > 

")<skip*a); 

end 

get 

list 

(ymax ) ; 

end; 

call  plot^Ssetup  (graph  titles  xlabel#  ylabel^  graph.t 
ype#  base*  grid_sw*  ea^s c a  I e_swT; 

if  (scale  auto  =  false)  then 

call  pTot_fscale  (xmin*  xmax*  ymin*  ymax); 

allocate  x; 
al locate  y; 


do  I  =  1  to  number^of^plots; 
x(*)  a  x_array(T**T; 
y(*)  a  y.array  ( t**); 
symbol  mark  a  symbol(l); 

call  pTot_  (x*  y*  num^si m^datarvec.sw*  symbol. mark) 
end; 

free  x*  y*  symbol; 
end  0 lot.t he.si m; 


end  choose_your.,p  lot  ; 


own_sys_t  o_s  i  rn:  orocedure  (matrix_dim/  time/  steo_end/  state, 

temo/ 

cont.state/  time.init/  time.'final) 


del  matrix  dim  fixeo  binary  (35)^ 

del  time  float  binary; 

del  steD_end  float  binary; 

del  state_temp  (IQ)  float  binary; 

del  cont_state  (10)  float  binary; 

del  time.init  float  binary; 

del  time..final  Heat  binary; 

del  ind  fixed  binary  (35); 

del  u ( 1 : mat r i X  di m /  1:9)  float  binary  controlled; 
del  tolerance  float  binary; 
del  c  (1:24)  float  binary; 
del  ier  Hxed  binary  (35); 

del  inDut_dim  fixed  external; 

del  pi  float; 
del  amp litude  float; 
del  freq  float; 
del  disturb  float; 
del  j  fixed; 

del  disturb_data  file; 
del  sysprint  file  output; 

del  imslSdverk  entry  (fixed  binary  (35)/  entry/  float  binary 
/  (*)  float 

binary/  float  binary/  float  binary/  fi 

xedbinary(35)/ 

(*)  float  binary/  fixed  binary  (35)/  ( 

*/*) f loat 

binary/  fixed  binary  (35)); 

pi  =  3,1415927; 
amp litude  ^  0, 1  ; 

freo  ~  20; 

tolerance  =  O.OOi; 
ind  =  1 ; 

if  (time  *  time_init)  then  do; 

disturb  =  amplitude  *  s i n ( 2*0 i * f r ea*t i me ) ; 
put  edit  ("A  f*PLITUD6  =  ••)(skip/a); 
put  list  (amplituce); 
put  edit  ("FREQ  =  ")(skip/a); 
put  list  (f  r eo)  ; 
end; 


allocate  u; 


call  i ms  I Sdve  r  k 
emo/  step.end/ 


(matrix_dim/  own_ c on t _ s y s t em 1 /  time/  state.t 
tolerance/  ind/  C/  matrix. dim/  w/  ier); 


disturb  =  amplitude  *  s i n ( 2*p i * f r eq * t i me ) ; 

c on t_ s t a t e ( 1 )  =  state.temp  (1)  -  disturb; 

free  w ; 


if  (ind  <  0  I  ier  >  0)  then  do; 
put  edit  ("time  =  ")(skip/a); 
put  list  (time); 

put  edit  ("ERROR!!  using  IMSL  ")(skip/a); 
put  edit  ("ind  =  *')(skip/a); 
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put  list  (i  nd)  ; 
put  edit  ("ier  =  ")(skip^a); 
put  list  (ier); 
end; 


oun_cont_syst em1 :  procedure  ( ma t r i x_d i m »  time#  state. temp/  s 
tate.temp^prime) ; 

/*  third  order  * / 


del  matrix  dim  fixed  binary  (35); 

del  time  float  binary; 

del  state.temp  (1C)  float  binary; 

del  s t a t e“t e mp^o r i me  (10)  float  binary; 

del  input_to_use  ( 1  :  i n pu t^d i m )  float  controlled  external; 
del  cont.input  ( 1 : i n pu t_d i m )  float  controlled  external; 

del  inout.dim  fixed  external; 
del  oun^n  fixed; 
del  own.,p  fixed; 

del  own.a.matrix  drown. n#  Irown.n)  float  controlled; 
del  own.b .matrix  drown. n#  Irown.p)  float  controlled; 

del  i  fixed; 
del  j  fixed; 

own.n  s  3; 
own.p  si; 

allocate  oun.a.matri x#  own.b.mat r  i  x  ; 


own, 

own, 

own, 

own. 

own, 

own, 

own. 

own, 

own. 


.a. mat  ri 
,a.mat  r  i 
.a_mat  r i 
.a. mat  ri 
.a.rnat  ri 
.a.rnat  ri 
.a.rnat  ri 
.a.rnat  ri 
.a.rnat  r i 


X  (Id)  =  o; 

x  d  /  2 )  =  1  ; 

X  (1  /  3 )  »  0  ; 

X  (2#1)  a  q; 

X  (2/2)  s  o; 

X  (2/3)  =  i; 

X  (3/1)  a  -249778.14; 
X  (3/2)  =  -140645.6; 

X  (3/3)  =  -181.98; 


own.b.matrix  (1/1) 
own.b.matrix  (2/1) 
own.b.matrix  (3/1) 


c; 

o; 

55493.2; 


do  i  =  1  to  own.n; 

St  at e.temp.pr i me  (i)  =  O; 
do  j  =1  to  owr.n; 

s t at e.t emp.p r ime  (i)  =  st at e.temp.pr i me  (i)  +  (oun.a.m 
atrix(i/j)*  ” 

state. temp  ( i ) ) ; 

end; 

end; 

do  i  =  1  to  own.n; 
do  j  a  1  to  own.p; 

s t at e.t emp.p r  ime  (i)  =  s t a t e.t emp.pr i me  (i)  +  (own  b  m 
atrix(i/j)* 

input. to. use  (i)); 

en  d ; 
end; 

free  own.a.ma t r  i  x  /  own.b.matrix; 
end  own.con t. s y s t em 1 ; 

own_cont.system2r  procedure  (matrix. dim/  time/  state. temp/  s 
tate. temp. prime) ; 

/*  fric  system  */ 
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del  matrix  dim  fixed  binary  (35); 

del  time  ftoat  binary; 

del  state^temo  (1C)  float  binary; 

del  St ate.t emo^p r ime  (10)  float  binary; 

del  n  fixed  external; 
del  0  fixed  external; 

del  input. to_use  (1:d)  float  eontrolled  external; 
del  eont  input  (1:p)  float  eontrolled  external; 
del  own_i_matrix  (1:n^  1:n)  float  controlled; 
del  ow  n__b_ma  t  r  1  x  (1:n^  1:p)  float  controlled; 

del  f  r  ic  float; 
del  i  fixed; 
del  j  fixed; 


allocate  own_a_matri x#  own.b.ma t r i x ; 
own.a.mat r i x~=  C; 
own  b.matrix  =  .395  ; 
if  (state  temo(1)  >  0,01)  then 
fric  =  D,0917; 
else  do; 

if  (  sta  te.tettip  ( 1 )  <  -0.01)  then 
fric  =  -0.0917; 
else  do; 

own.a.matrix  =  -9,17; 
fric  =  0 ; 
end; 
end; 


do  i  =  1  to  n; 

state.temp. prime  (i)  =  0 
do  i  *  1  to  n; 

state. temp.prime  (i)  » 
atrix  (i#  j>  * 

end; 

end; 


s  t  a t  e. t  emp.pr i me 
state. temp  ( j ) ) ; 


( i ) 


+  (own.a.m 


do  i  =1  to  n; 
do  j  a  1  to  p; 

state.temp.pr  ime  (i) 
atrix  (i#  j)  * 

end; 

end; 

free  own.a.ma t r i x ^  own.b. 
end  own. eont. syst em2; 


a  state.temp.pr i me 
i nput_to.use  ( j ) ) 


matrix; 


(i)  +  (own.b.m 
-  fric; 


own. eont. syst em3 :  procedure  (matrix. dim^  time^  state. temp#  s 
tate.temp.prime) ; 


del  matrix  dim  fixed  binary  (35); 

del  time  float  binary; 

del  state.temp  (10)  float  binary; 

del  s t a t e.t emp.p r  ime  (10)  float  binary; 


del  n  fixed  ex-ternai; 
dclpfixed  external; 

del  input. to. use  (1:p)  float  controlled  external; 
del  eont. input  (1:p)  float  controlled  external; 
del  a_matrix  (1  :  1:n)  float  controlled  external; 

del  b. matrix  (1:n^  1:o)  float  controlled  external; 
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del  i  fixed; 
del  j  fixed; 


do  i  =  1  to  n; 

state_temp_priiTe  (i)  =  O; 
do  j  =  1  to  n; 

s t ate_t emp^p r  ime  <i)  =  s t a t e_ t emp.p r i me  (i)  +  (a_matri 
X  ( i  ^  j  )  * 

state. temp  (j)); 

end ; 
end; 

do  i  =  1  to  n; 
do  j  =1  to  p; 

s t a t e_t emp_p r  ime  (i)  =  st at e_t emp.pr i me  (i)  +  (b.matri 
X  ( i  ^  j  )  * 

i  nput.to.use  ( j ) ) ; 

end; 

end; 

end  oun.eont.syst  eir3; 
end  own. sys.,to. sim; 
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convert.;  procedure; 

del  n  fixed  external; 
del  D  fixed  external; 

del  offset.s  (1:n)  fixed  controlled  external; 
del  offset.i  (1:p)  fixed  controlled  external; 

del  VO  1 1 age _l owe r.bcun d_s  (1:n)  float  controlled  external; 
del  VO  1 1  age.  t  o  uer  _b  cund.  i  dtp)  float  controlled  external; 
del  quan tum.s t ep. s  i  ze. s  (1:n)  float  controlled  external; 
del  quantum.s t ep_ s  i  ze.  i  (1:p)  float  controlled  external; 

del  i  fixed; 
del  state. code  fixed; 
del  input. code  fixed; 
del  dis. state  (*)  fixec; 
del  dis. input  (*)  fixed; 

del  cont. state  (*)  float; 
del  cont. input  (*)  float; 


con t.s t a t e. to. di s. s ta t e :  entry  (cont. state#  dis. state); 
doi  =1  to  n; 

dis.state(i)  =  floor  ( ( c ont .s t a t e ( i )  -  vo 1 1 a qe. I  owe r.bound 
_s(i  )  ) 

/  quantu 

m.step.size. s(i  )  ); 

eng; 


return; 

dis. state.to. code:  entry  (dis. state#  state. code); 

state. code  = 
do  i  *  1  to  n; 

state. code  =  state. code  +  (dis. state  (i)  *  offset. s  (i)) 
end; 
return; 


cod e. t o. d i s.s t a t e  ;  entry  (state.code#  dis. state); 

state.code  =  state  code  -  l; 
do  i  =  n  by  -1toT; 

dis. state  (i)  =  floor  (state.code  /  offset. s  (i)); 
state.code  =  mod  (state.code#  offset.s  (i)); 
end; 

return; 


d  i  s .s t a t e.t 0. con t . s t at e :  entry  (dis. state#  cont. state); 
do  i  =  1  to  n; 

cont.state( i  )  =  ( (d i s.s t at e ( i )  +  0,5)  *  quan tu m. s t ep.s i ze. 
s  ( i )  ) 

♦  voltage. I 

ower.bound.s (  i )  ; 
end; 

return; 
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CO n i npu t _ t o_ d i s ^ i rou t :  entry  (cont^inout/  dis.input); 
do  i  =  1  to  p; 

dis  input(i)  =  floor  ((cont  inputCi)  -  vo 1 1 a ge^ I  owe r _ b ou n d 
i  (i  )  ) 

/  quant  u 

'll.  s  t  e  p_  s  i  2  e_  i  ( i  )  )  ; 
end; 

return; 


d i s^i nDut_t o_ c ode  :  entry  (dis_inout/  input.code); 

i npu  t^code  =  1  ; 
do  1  =  1  to  p; 

input^code  =  input_code  +  (dis_input  (i)  *  offset^!  (i)) 
end; 
return; 


code_to_di  s_'j  nput  :  ent  ry  (input_code#  dis.input); 

inout^code  =  input  code  -  1; 
do  i  a  p  by  -1  toT; 

dis_rnput  (i)  =  floor  (rnout_code  /  offset  i  (i)>; 
input^code  =  mod  (input^code^  offset^!  (i)!; 
end; 

return  ; 


dis_input^to^cont_input:  entry  (dis.input^  cont.input); 
do  i  »  1  to  p; 

cont _ i npu t (  i  )  =  < (di  s.input  (  i  )  +  0^5)  *  quantum^step.s i 2e_ 
i  ( i  )  ) 

+  70 1 1  a  ge_  I 

ower_bound_i ( i)  ; 
end; 

return; 

end  convert_; 
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num^a nsue r_ok :  proceaure  (c*  range/  choice); 

del  c  character  (1); 
dc  I  range  fixed; 
del  choice  fixed# 

dc I  i  f i xed; 

del  good^answ e r_ f I ag  bit(1); 
del  true  bit(1)  initial  ('*1”b); 
del  false  bit(1)  initial  (**0”b); 

del  sysin  file  input; 
del  sysprint  file  output; 


good  answer_f  lag  =  false; 
do  while  (good_ansuer  flag  =  false); 
if  (c  >=  "O"  8  e  <=  "9^)  then 
do; 

ehoi  c  e  *  e  ; 

do  i  =  1  by  1  to  range; 
i f  (ehoiee  =  i >  then 

good_answer  flag  =  true; 

end; 

end; 

if  (qood_answer  flag  a  false)  then 
do; 

put  edit  ("Ineorreet  Response "/"Try  Again  »>  ") 

(skip/  a/  skip/  a); 

get  list  (e) ; 
end? 
else 

choice  =  c : 
end;  /*while*/ 

end  num^answer^ok; 
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yn_an su er _o k ;  procedure  (answer);  . 

del  answer  character  (3)  varying; 

del  good  answer  flag  bit(1); 
del  true~bit(1)~  imtial  <‘'1”b); 
del  false  bit(i)  initial  (’'Q"b); 

del  sysinfile  input; 
del  sysprint  file  output; 

if  (answer  =  "y"  I  answer  =  "yes'*  I  answer  =  "no”  I  answer  = 
"  n  " ) 

then  gogd_a nswe r^f I ag  =  true; 
else 

good^an sue r_f I ag  =  false; 

do  uh i I e  (good  an swer_ f  lag  =  false); 

put  edit  ("Incorrect  Response"#  "Try  Again  =>  •") 

(skip#  a#  skip#  a); 

getlist(ansuer); 

if  (answer  =  "y"  I  answer  =  "yes"  1  answer  =  "no"  I 

answer  =  "n”)  then 

good_an s we r _ f  la g  =  true; 
e  I  se  • 

goQd_an swer^f lag  =  false; 
end;  /*uhile*/ 

end  y n_a ns  we r_o k ; 
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